Closed Loop Control of 3D Underactuated Vehicles via Velocity Field Tracking

A novel strategy to design time invariant motion controllers for underactuated mobile systems is applied to the position and attitude control of an underactuated 3D vehicle. The idea involves defining a velocity vector field such that an ideal, fully actuated system would exponentially achieve the control objective by simply following such field. A steering law for the given underactuated system is then designed such that it is exponentially stabilized parallel to the above mentioned velocity vector field. For the problem addressed, due to the use of polar like coordinates, this method yields a discontinuous control law. Both the design process and the resulting solution give a clear physical interpretation. Important practical requirements for approaching the target on a null curvature path, avoiding cusps in the whole path and moving in only one given forward direction, are easily satisfied within this framework