Dynamic Motion Planning for Aerial Surveillance on a Fixed-Wing UAV

We present an efficient path planning algorithm for an Unmanned Aerial Vehicle surveying a cluttered urban landscape. A special emphasis is on maximizing area surveyed while adhering to constraints of the UAV and partially known and updating environment. A Voronoi bias is introduced in the probabilistic roadmap building phase to identify certain critical milestones for maximal surveillance of the search space. A kinematically feasible but coarse tour connecting these milestones is generated by the global path planner. A local path planner then generates smooth motion primitives between consecutive nodes of the global path based on UAV as a Dubins vehicle and taking into account any impending obstacles. A Markov Decision Process (MDP) models the control policy for the UAV and determines the optimal action to be undertaken for evading the obstacles in the vicinity with minimal deviation from current path. The efficacy of the proposed algorithm is evaluated in an updating simulation environment with dynamic and static obstacles.Comment: Accepted at International Conference on Unmanned Aircraft Systems 201

Simplex Solutions for Optimal Control Flight Paths in Urban Environments

This paper identifies feasible fight paths for Small Unmanned Aircraft Systems in a highly constrained environment. Optimal control software has long been used for vehicle path planning and has proven most successful when an adequate initial guess is presented flight to an optimal control solver. Leveraging fast geometric planning techniques, a large search space is discretized into a set of simplexes where a Dubins path solution is generated and contained in a polygonal search corridor free of path constraints. Direct optimal control methods are then used to determine the optimal flight path through the newly defined search corridor. Two scenarios are evaluated. The first is limited to heading rate control only, requiring the air vehicle to maintain constant speed. The second allows for velocity control which permits slower speeds, reducing the vehicles minimum turn radius and increasing the search domain. Results illustrate the benefits gained when including speed control to path planning algorithms by comparing trajectory and convergence times, resulting in a reliable, hybrid solution method to the SUAS constrained optimal control problem

Simplex Control Methods for Robust Convergence of Small Unmanned Aircraft Flight Trajectories in the Constrained Urban Environment

Constrained optimal control problems for Small Unmanned Aircraft Systems (SUAS) have long suffered from excessive computation times caused by a combination of constraint modeling techniques, the quality of the initial path solution provided to the optimal control solver, and improperly defining the bounds on system state variables, ultimately preventing implementation into real-time, on-board systems. In this research, a new hybrid approach is examined for real-time path planning of SUAS. During autonomous flight, a SUAS is tasked to traverse from one target region to a second target region while avoiding hard constraints consisting of building structures of an urban environment. Feasible path solutions are determined through highly constrained spaces, investigating narrow corridors, visiting multiple waypoints, and minimizing incursions to keep-out regions. These issues are addressed herein with a new approach by triangulating the search space in two-dimensions, or using a tetrahedron discretization in three-dimensions to define a polygonal search corridor free of constraints while alleviating the dependency of problem specific parameters by translating the problem to barycentric coordinates. Within this connected simplex construct, trajectories are solved using direct orthogonal collocation methods while leveraging navigation mesh techniques developed for fast geometric path planning solutions. To illustrate two-dimensional flight trajectories, sample results are applied to flight through downtown Chicago at an altitude of 600 feet above ground level. The three-dimensional problem is examined for feasibility by applying the methodology to a small scale problem. Computation and objective times are reported to illustrate the design implications for real-time optimal control systems, with results showing 86% reduction in computation time over traditional methods

Coverage and Time-optimal Motion Planning for Autonomous Vehicles

Autonomous vehicles are rapidly advancing with a variety of applications, such as area surveillance, environment mapping, and intelligent transportation. These applications require coverage and/or time-optimal motion planning, where the major challenges include uncertainties in the environment, motion constraints of vehicles, limited energy resources and potential failures. While dealing with these challenges in various capacities, this dissertation addresses three fundamental motion planning problems: (1) single-robot complete coverage in unknown environment, (2) multi-robot resilient and efficient coverage in unknown environment, and (3) time-optimal risk-aware motion planning for curvature-constrained vehicles. First, the ε* algorithm is developed for online coverage path planning in unknown environment using a single autonomous vehicle. It is computationally efficient, and can generate the desired back-and-forth path with less turns and overlappings. ε* prevents the local extrema problem, thus can guarantee complete coverage. Second, the CARE algorithm is developed which extends ε* for multi-robot resilient and efficient coverage in unknown environment. In case of failures, CARE guarantees complete coverage via dynamic task reallocations of other vehicles, hence provides resilience. Moreover, it reallocates idling vehicles to support others in their tasks, hence improves efficiency. Finally, the T* algorithm is developed to find the time-optimal risk-aware path for curvature-constrained vehicles. We present a novel risk function based on the concept of collision time, and integrate it with the time cost for optimization. The above-mentioned algorithms have been validated via simulations in complex scenarios and/or real experiments, and the results have shown clear advantages over existing popular approaches

Nonholonomic Motion Planning as Efficient as Piano Mover's

We present an algorithm for non-holonomic motion planning (or 'parking a car') that is as computationally efficient as a simple approach to solving the famous Piano-mover's problem, where the non-holonomic constraints are ignored. The core of the approach is a graph-discretization of the problem. The graph-discretization is provably accurate in modeling the non-holonomic constraints, and yet is nearly as small as the straightforward regular grid discretization of the Piano-mover's problem into a 3D volume of 2D position plus angular orientation. Where the Piano mover's graph has one vertex and edges to six neighbors each, we have three vertices with a total of ten edges, increasing the graph size by less than a factor of two, and this factor does not depend on spatial or angular resolution. The local edge connections are organized so that they represent globally consistent turn and straight segments. The graph can be used with Dijkstra's algorithm, A*, value iteration or any other graph algorithm. Furthermore, the graph has a structure that lends itself to processing with deterministic massive parallelism. The turn and straight curves divide the configuration space into many parallel groups. We use this to develop a customized 'kernel-style' graph processing method. It results in an N-turn planner that requires no heuristics or load balancing and is as efficient as a simple solution to the Piano mover's problem even in sequential form. In parallel form it is many times faster than the sequential processing of the graph, and can run many times a second on a consumer grade GPU while exploring a configuration space pose grid with very high spatial and angular resolution. We prove approximation quality and computational complexity and demonstrate that it is a flexible, practical, reliable, and efficient component for a production solution.Comment: 34 pages, 37 figures, 9 tables, 4 graphs, 8 insert

Distributed Task Allocation and Task Sequencing for Robots with Motion Constraints

This thesis considers two routing and scheduling problems. The first problem is task allocation and sequencing for multiple robots with differential motion constraints. Each task is defined as visiting a point in a subset of the robot configuration space -- this definition captures a variety of tasks including inspection and servicing, as well as one-in-a-set tasks. Our approach is to transform the problem into a multi-vehicle generalized traveling salesman problem (GTSP). We analyze the GTSP insertion methods presented in literature and we provide bounds on the performance of the three insertion mechanisms. We then develop a combinatorial-auction-based distributed implementation of the allocation and sequencing algorithm. The number of the bids in a combinatorial auction, a crucial factor in the runtime, is shown to be linear in the size of the tasks. Finally, we present extensive benchmarking results to demonstrate the improvement over existing distributed task allocation methods. In the second part of this thesis, we address the problem of computing optimal paths through three consecutive points for the curvature-constrained forward moving Dubins vehicle. Given initial and final configurations of the Dubins vehicle and a midpoint with an unconstrained heading, the objective is to compute the midpoint heading that minimizes the total Dubins path length. We provide a novel geometrical analysis of the optimal path and establish new properties of the optimal Dubins' path through three points. We then show how our method can be used to quickly refine Dubins TSP tours produced using state-of-the-art techniques. We also provide extensive simulation results showing the improvement of the proposed approach in both runtime and solution quality over the conventional method of uniform discretization of the heading at the mid-point, followed by solving the minimum Dubins path for each discrete heading

Airborne mapping of complex obstacles using 2D Splinegon

This paper describes a recently proposed algorithm in mapping the unknown obstacle in a stationary environment where the obstacles are represented as curved in nature. The focus is to achieve a guaranteed performance of sensor based navigation and mapping. The guaranteed performance is quantified by explicit bounds of the position estimate of an autonomous aerial vehicle using an extended Kalman filter and to track the obstacle so as to extract the map of the obstacle. This Dubins path planning algorithm is used to provide a flyable and safe path to the vehicle to fly from one location to another. This description takes into account the fact that the vehicle is made to fly around the obstacle and hence will map the shape of the obstacle using the 2D-Splinegon technique. This splinegon technique, the most efficient and a robust way to estimate the boundary of a curved nature obstacles, can provide mathematically provable performance guarantees that are achievable in practice