This paper presents planning and control algorithms for a multi-rotor with a suspended load. The suspended load cannot be controlled easily by the multi-rotor due to severe dynamic coupling between them. Difficulties are exacerbated by under-actuated, highly nonlinear nature of multi-rotor dynamics. Although many studies have been proposed to plan trajectories and control this system, there exist only a few reports on real-time trajectory generation. With this in mind, we propose a planning method which is capable of generating collision-free trajectories real-time and applicable to a high-dimensional nonlinear system. Using a differential flatness property, the system can be linearized entirely with elaborately chosen flat outputs. Convexification of non-convex constraints is carried out, and concave obstacle-avoidance constraints are converted to convex ones. After that, a convex optimization problem is solved to generate an optimal trajectory, but semi-feasible trajectory which considers only some parts of the initial state. We apply model predictive control with a sequential linear quadratic solver to compute a feasible collision-free trajectory and to control the system. Performance of the algorithm is validated by flight experiment.
[1]
Aaas News,et al.
Book Reviews
,
1893,
Buffalo Medical and Surgical Journal.
[2]
Fei Gao,et al.
Online quadrotor trajectory generation and autonomous navigation on point clouds
,
2016,
2016 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR).
[3]
Rafael Fierro,et al.
Cable-suspended load lifting by a quadrotor UAV: hybrid model, trajectory generation, and control
,
2017,
Auton. Robots.
[4]
Stephen P. Boyd,et al.
Convex Optimization
,
2004,
Algorithms and Theory of Computation Handbook.
[5]
Vijay Kumar,et al.
Mixed Integer Quadratic Program trajectory generation for a quadrotor with a cable-suspended payload
,
2015,
2015 IEEE International Conference on Robotics and Automation (ICRA).
[6]
R. Stephenson.
A and V
,
1962,
The British journal of ophthalmology.
[7]
Daniel Mellinger,et al.
Trajectory generation and control for quadrotors
,
2012
.