Venanzio Cichella

Calvin Kielas-Jensen, Venanzio Cichella

This paper presents a method and an open-source implementation, Bernstein/Bézier Optimal Trajectories (BeBOT), for the generation of trajectories for autonomous system operations. The proposed method is based on infinite dimensional optimal control formulations of trajectory generation problems. By approximating the trajectories using Bernstein polynomials, these problems can be transcribed as nonlinear programming problems, which can then be solved using off-the-shelf solvers. Bernstein polynomials possess favorable geometric properties that enable the trajectory planner to efficiently evaluate and enforce constraints along the vehicles' trajectories, including maximum speed and angular rates, minimum distance between trajectories and between the vehicles and obstacles. By virtue of these properties, feasibility and safety constraints typically imposed in autonomous vehicle operations can be enforced and guaranteed independently on the order of the polynomials. Thus, the trajectory generation algorithm can efficiently generate feasible and collision-free trajectories, and can be deployed for real-time safety critical applications in complex environments and for multiple vehicle missions.

Thiago Marinho, Massi Amrouche, Dusan Stipanovic et al.

Biological evidence shows that animals are capable of evading eminent collision without using depth information, relying solely on looming stimuli. In robotics, collision avoidance among uncooperative vehicles requires measurement of relative distance to the obstacle. Small, low-cost mobile robots and UAVs might be unable to carry distance measuring sensors, like LIDARS and depth cameras. We propose a control framework suitable for a unicycle-like vehicle moving in a 2D plane that achieves collision avoidance. The control strategy is inspired by the reaction of invertebrates to approaching obstacles, relying exclusively on line-of-sight (LOS) angle, LOS angle rate, and time-to-collision as feedback. Those quantities can readily be estimated from a monocular camera vision system onboard a mobile robot. The proposed avoidance law commands the heading angle to circumvent a moving obstacle with unknown position, while the velocity controller is left as a degree of freedom to accomplish other mission objectives. Theoretical guarantees are provided to show that minimum separation between the vehicle and the obstacle is attained regardless of the exogenous tracking controller.

Arun Lakshmanan, Andrew Patterson, Venanzio Cichella et al.

In motion planning problems for autonomous robots, such as self-driving cars, the robot must ensure that its planned path is not in close proximity to obstacles in the environment. However, the problem of evaluating the proximity is generally non-convex and serves as a significant computational bottleneck for motion planning algorithms. In this paper, we present methods for a general class of absolutely continuous parametric curves to compute: (i) the minimum separating distance, (ii) tolerance verification, and (iii) collision detection. Our methods efficiently compute bounds on obstacle proximity by bounding the curve in a convex region. This bound is based on an upper bound on the curve arc length that can be expressed in closed form for a useful class of parametric curves including curves with trigonometric or polynomial bases. We demonstrate the computational efficiency and accuracy of our approach through numerical simulations of several proximity problems.

Venanzio Cichella, Isaac Kaminer, Claire Walton et al.

Bernstein polynomial approximation to a continuous function has a slower rate of convergence as compared to other approximation methods. "The fact seems to have precluded any numerical application of Bernstein polynomials from having been made. Perhaps they will find application when the properties of the approximant in the large are of more importance than the closeness of the approximation." -- has remarked P.J. Davis in his 1963 book Interpolation and Approximation. This paper presents a direct approximation method for nonlinear optimal control problems with mixed input and state constraints based on Bernstein polynomial approximation. We provide a rigorous analysis showing that the proposed method yields consistent approximations of time continuous optimal control problems. Furthermore, we demonstrate that the proposed method can also be used for costate estimation of the optimal control problems. This latter result leads to the formulation of the Covector Mapping Theorem for Bernstein polynomial approximation. Finally, we explore the numerical and geometric properties of Bernstein polynomials, and illustrate the advantages of the proposed approximation method through several numerical examples.