NMPC-Based Trajectory Optimization and Hierarchical Control of a Ducted Fan Flying Robot with a Robotic Arm

Ducted fan flying robots with robotic arms can perform physical interaction tasks in complex environments such as indoors. However, the coupling effects between the aerial platform, the robotic arm, and physical environment pose significant challenges for the robot to accurately approach and stably contact the target. To address this problem, we propose a unified control framework for a ducted fan flying robot that encompasses both flight planning and physical interaction. This contribution mainly includes the following: (1) A nonlinear model predictive control (NMPC)-based trajectory optimization controller is proposed, which achieves accurate and smooth tracking of the robot’s end effector by considering the coupling of redundant states and various motion and performance constraints, while avoiding potential singularities and dangers. (2) On this basis, an easy-to-practice hierarchical control framework is proposed, achieving stable and compliant contact of the end effector without controller switching between the flight and interaction processes. The results of experimental tests show that the proposed method exhibits accurate position tracking of the end effector without overshoot, while the maximum fluctuation is reduced by up to 75.5% without wind and 71.0% with wind compared to the closed-loop inverse kinematics (CLIK) method, and it can also ensure continuous stable contact of the end effector with the vertical wall target.