Concurrent Optimal Trajectory Planning for Indoor Quadrotor Formation Switching
- 115 Downloads
This paper presents a novel concurrent optimal trajectory planning method for a team of quadrotors to switch between various formation patterns in the confined indoor environment. Using static shape-based, dynamic trajectory-based approaches, different formation patterns of quadrotors can be optimally and rapidly arranged and localized. The modified algorithm of optimal reciprocal collision avoidance (ORCA) is applied to produce the nominal collision-free trajectories for the quadrotor team as the first stage, which is extended to three-dimensional space and the downwash effect induced by the propellers is effectively addressed. Considering the flatness property of the quadrotor dynamics, the jerk-optimized trajectories based on the cubic clamped B-spline are then generated and these corresponding constraints are also satisfied. Moreover, a robust perfect tracking (RPT) outer-loop controller is designed to compensate the poor resolution of the indoor localization system. Finally, simulations are conducted to verify these proposed algorithms, and the real-world flight result was successfully showcased at the opening ceremony of Rotorcraft Asia & Unmanned Systems Asia 2017.
KeywordsMultiple quadrotors Collision avoidance Path planning Trajectory generation Indoor environment
Mathematics Subject Classification (2010)93C35 93C85 93C95
JEL Classification (2010)93 Systems theory; control
Unable to display preview. Download preview PDF.
This work was supported by National Natural Science Foundation of China [grant number 61673327], China Scholarship Council [grant number 201606310153], as well as Aviation Science Foundation of China [grant number 20160168001]. The authors would like to thank Prof. Ben M. Chen and his Unmanned System Research Group at National University of Singapore.
- 1.Agha-mohammadi, A.-a., Ure, N.K., How, J.P., Vian. J.: Health aware stochastic planning for persistent package delivery missions using quadrotors. In: IEEE /RSJ International Conference on Intelligent Robots and Systems, pp. 3389–3396. Chicago (2014)Google Scholar
- 2.Alvissalim, M.S., Zaman, B., Hafizh, Z.A., Ma’sum, M.A., Jati, G., Jatmiko, W., Mursanto, P.: Swarm quadrotor robots for telecommunication network coverage area expansion in disaster area. In: Annual Conference of the Society of Instrument and Control Engineers of Japan, pp. 2256–2261. Akita (2012)Google Scholar
- 5.Chen, B.M., Lee, T.H., Peng, K.M., Venkataramanan, V.: Hard Disk Drive Servo Systems, 2nd edn. Springer, London (2006)Google Scholar
- 12.Guérin, F., Guinand, F., Brethé, J.F., Pelvillain, H., et al.: Towards an autonomous warehouse inventory scheme. In: IEEE Symposium Series on Computational Intelligence, pp. 1–8, Athens (2016)Google Scholar
- 17.Kumar, V., Michael, N.: Opportunities and challenges with autonomous micro aerial vehicles. In: Robotics Research, pp. 41–58. Springer (2017)Google Scholar
- 18.Kuriki, Y., Namerikawa, T.: Consensus-based cooperative formation control with collision avoidance for a multi-UAV system. In: American Control Conference, pp. 2077–2082. Portland (2014)Google Scholar
- 19.Mellinger, D., Kumar, V.: Minimum snap trajectory generation and control for quadrotors. In: IEEE International Conference on Robotics and Automation, pp. 2520–2525. Shanghai (2011)Google Scholar
- 20.Mellinger, D., Kushleyev, A., Kumar, V.: Mixed-integer quadratic program trajectory generation for heterogeneous quadrotor teams. In: IEEE International Conference on Robotics and Automation, pp. 477–483. St Paul (2012)Google Scholar
- 25.Van Den Berg, J., Guy, S.J., Lin, M., Manocha, D.: Reciprocal n-body collision avoidance. In: Robotics research, pp. 3–19. Springer (2011)Google Scholar