Formation control of unmanned rotorcraft systems with state constraints and inter-agent collision avoidance
Tóm tắt
We present in this paper a novel framework and distributed control laws for the formation of multiple unmanned rotorcraft systems, be it single-rotor helicopters or multi-copters, with physical constraints and with inter-agent collision avoidance, in cluttered environments. The proposed technique is composed of an analytical distributed consensus control solution in the free space and an optimization based motion planning algorithm for inter-agent and obstacle collision avoidance. More specifically, we design a distributed consensus control law to tackle a series of state constraints that include but not limited to the physical limitations of velocity, acceleration and jerk, and an optimization-based motion planning technique is utilized to generate numerical solutions when the consensus control fails to provide a collision-free trajectory. Besides, a sufficiency condition is given to guarantee the stability of the switching process between the consensus control and motion planning. Finally, both simulation and real flight experiments successfully demonstrate the effectiveness of the proposed technique.
Tài liệu tham khảo
B.M. Chen, On the trends of autonomous unmanned systems research. Engineering 12, 20–23 (2021). https://doi.org/10.1016/j.eng.2021.10.014.
S. Zhao, Affine formation maneuver control of multiagent systems. IEEE Trans. Autom. Control 63(12), 4140–4155 (2018)
X. Ge, Q.L. Han, Distributed formation control of networked multi-agent systems using a dynamic event-triggered communication mechanism. IEEE Trans. Ind. Electron. 64(10), 8118–8127 (2017)
Y. Li, H. Fang, J. Chen, Anomaly detection and identification for multiagent systems subjected to physical faults and cyberattacks. IEEE Trans. Ind. Electron. 67(11), 9724–9733 (2019)
M. Wang, J. Sun, J. Chen, Input-to-state stability of perturbed nonlinear systems with event triggered receding horizon control scheme. IEEE Trans. Ind. Electron. 66(8), 6393–6403 (2018)
P. Zhou, B.M. Chen, Semi-global leader-following output consensus of heterogeneous systems with position and rate-limited actuators via state feedback, in Proceedings of the 40th Chinese Control Conference, Shanghai, China, July 26-28, 2021, 2021, pp. 5295–5302
X. Dong, Y. Zhou, Z. Ren, Y. Zhong, Time-varying formation tracking for second-order multi-agent systems subjected to switching topologies with application to quadrotor formation flying. IEEE Trans. Ind. Electron. 64(6), 5014–5024 (2016)
X. Dong, G. Hu, Time-varying formation tracking for linear multiagent systems with multiple leaders. IEEE Trans. Autom. Control 62(7), 3658–3664 (2017)
L. Ding, Q.L. Han, G. Guo, Network-based leader-following consensus for distributed multi-agent systems. Automatica 49(7), 2281–2286 (2013)
S. Zhao, D. Zelazo, Translational and scaling formation maneuver control via a bearing-based approach. IEEE Trans. Control Netw. Syst. 4(3), 429–438 (2015)
Y. Hua, X. Dong, G. Hu, Q. Li, Z. Ren, Distributed time-varying output formation tracking for heterogeneous linear multiagent systems with a nonautonomous leader of unknown input. IEEE Trans. Autom. Control 64(10), 4292–4299 (2019)
Y. Su, J. Huang, Stability of a class of linear switching systems with applications to two consensus problems. IEEE Trans. Autom. Control 57(6), 1420–1430 (2011)
H. Su, M.Z.Q. Chen, X. Wang, J. Lam, Semiglobal observer-based leader-following consensus with input saturation. IEEE Trans. Ind. Electron. 61(6), 2842–2850 (2013)
Y. Lv, J. Fu, G. Wen, T. Huang, X. Yu, Distributed adaptive observer-based control for output consensus of heterogeneous MASs with input saturation constraint. IEEE Trans. Circuits Syst. I, Regul. Pap. 67(3), 995–1007 (2019)
Z. Zhao, H. Shi, Semi-global containment control for linear systems in the presence of actuator position and rate saturation. Int. J. Robust Nonlinear Control 29(1), 1–18 (2019)
L. Kou, Z. Chen, J. Xiang, Cooperative fencing control of multiple vehicles for a moving target with an unknown velocity. IEEE Trans. Autom. Control 67(2), 1008–1015 (2021)
R. Falconi, L. Sabattini, C. Secchi, C. Fantuzzi, C. Melchiorri, Edge-weighted consensus-based formation control strategy with collision avoidance. Robotica 33(2), 332–347 (2015)
L. Kou, Y. Huang, Z. Chen, S. He, J. Xiang, Cooperative fencing control of multiple second order vehicles for a moving target with and without velocity measurements. Int. J. Robust Nonlinear Control 31(10), 4602–4615 (2021)
P.E. Hart, N.J. Nilsson, B. Raphael, A formal basis for the heuristic determination of minimum cost paths. IEEE Trans. Cybern. 4(2), 100–107 (1968)
S. Karaman, E. Frazzoli, Incremental sampling-based algorithms for optimal motion planning, in Robotics Science and Systems VI, 104(2) (2010), pp. 267–274
J.D. Gammell, S.S. Srinivasa, T.D. Barfoot, Batch informed trees (BIT*): sampling-based optimal planning via the heuristically guided search of implicit random geometric graphs, in Proceeding of the 2015 IEEE International Conference on Robotics and Automation (ICRA) (2015), pp. 3067–3074
W. Wu, Temporal scheduling and optimization for multi-mav planning. PhD thesis (2019)
S.H. Arul, D. Manocha, DCAD: decentralized collision avoidance with dynamics constraints for agile quadrotor swarms. IEEE Robot. Autom. Lett. 5(2), 1191–1198 (2020)
Y. Su, J. Huang, Cooperative output regulation of linear multi-agent systems. IEEE Trans. Autom. Control 57(4), 1062–1066 (2011)
Y. Dong, Z. Lin, An event-triggered observer and its applications in cooperative control of multi-agent systems. IEEE Trans. Autom. Control 67(7), 3647–3654 (2022)
Y. Kuriki, T. Namerikawa, Formation control with collision avoidance for a multi-UAV system using decentralized MPC and consensus-based control. SICE J. Control Meas. Syst. Integr. 8(4), 285–294 (2015)
C. Chang, J. Shiau, Quadrotor formation strategies based on distributed consensus and model predictive controls. Appl. Sci. 8(11), 2246 (2018)
M. Ille, T. Namerikawa, Collision avoidance between multi-UAV-systems considering formation control using MPC, in 2017 IEEE International Conference on Advanced Intelligent Mechatronics (AIM) (2017), pp. 651–656
G. Cai, B.M. Chen, T.H. Lee, K. Lum, Comprehensive nonlinear modeling of a miniature unmanned helicopter. J. Am. Helicopter Soc. 57(1), 1–13 (2012)
G. Cai, B.M. Chen, T.H. Lee, Unmanned Rotorcraft Systems (Springer, Berlin, 2011)
S.K. Phang, System design methodology and implementation of micro-unmanned aerial vehicles. PhD thesis, National University of Singapore (2014)
R. Deits, R. Tedrake, Computing large convex regions of obstacle-free space through semidefinite programming, in Algorithmic Foundations of Robotics XI (Springer, Berlin, 2015), pp. 109–124
J. Alonso-Mora, E. Montijano, T. Nageli, O. Hilliges, M. Schwager, D. Rus, Distributed multi-robot formation control in dynamic environments. Auton. Robots 43(5), 1079–1100 (2019)
Z. Lin, Low Gain Feedback (Springer, London, 1999)
S. Lai, M. Lan, B.M. Chen, Model predictive local motion planning with boundary state constrained primitives. IEEE Robot. Autom. Lett. 4(4), 3577–3584 (2019)