Open Access Open Access  Restricted Access Subscription Access

Simulation and Experimental Study of Formation Control of Multi Humanoid Robots

Faisal Wahab, Riyanto Bambang


Distributed formation control of multi humanoid robot system with obstacle avoidance and collision avoidance are presented. The architecture consists of several layers, namely consensus tracking, consensus based formation control, behaviour and physical robot layers. The formation control system was simulated in MATLAB software before it was implemented to humanoid NAO Aldebaran robots. In the experimental study the visual odometry was used to track the robots’ position and their moving direction. The result of the experiment showed that the distributed formation control design was succeed in directing the robots into their planned formation, avoiding obstacles, and avoiding collisions among themselves with certain communication topology, shape of formation, obstacles’ position and their number.

Full Text:



Beard R. W., J. Lawton, and F. Y. Hadaegh, “A coordination architecture for spacecraft formation control,” IEEE Control Systems Technology, 1063–6536, 2001.

Corke, Peter, Robotics, Vision and Control: “Fundamental Algorithm in MATLAB,” Springer Tracts in Advance Robotics, 2011.

D.M. Stipanovic ´, P.F. Hokayem, M.W. Spong, D.D. Siljak, “Avoidance control for multi-agent systems,” ASME Journal of Dynamic Systems, Measurement and Control 129 (5) 699–707, 2007.

Guanghua, Wang, “Study on Formation Control of Multi-Robot Systems,” Third International Conference on Intelligent System Design and Engineering Applications, 2013.

Jian-Fu, C., Zhi-Hao, L., et. al.,”Distributed formation control for a multi-agent system with dynamic and static obstacle avoidance,” Chinese Physical Society and IOP Publishing Ltd, 2014.

Khatib, O., “Real-Time Obstacle Avoidance for Manipulators and Mobile Robots,” International Journal on Robotics Research, 1986.

Li, Y., Tang, G., Yang, X., Wang, P., “Collision-free Consensus in Second-order Multi-agent Dynamical System,” Chinese Control Conference, 2012.

Liu Jiming and Jianbing Wu, “Multi-Agent Robotic Systemst,” CRC Press, London, 2001.

Michieletto, Stefano and Menegatti, Emanuele “Human action recognition oriented to humanoid robots action reproduction,”__________

Oriolo, Giuseppe, Antonio Paulillo, Lorenzo Rosa and Marilena Vendittelli., “Vision-Based Odometric Localization for Humanoids using aKinematic EKF.” Proceedings of 12 th IEEE-RAS Int'l Conf. on Humanoid Robots, Osaka, Japan, pp. 153-158, 2012.

Oriolo, Giuseppe, Antonio Paulillo, Lorenzo Rosa and Marilena Vendittelli, “Vision-Based Trajectory Control for Humanoids Navigation, Proceedings” of 13th IEEERAS Int'l Conf. on Humanoid Robots, Atlanta, USA. pp. 118-123, 2013.

P. F. Hokayem, D. M. Stipanovic, M. W. Spong, “Coordination and Collision Avoidance for Lagrangian systems with disturbances,” Applied Mathematics and Computation, Vol.217,No.3, 1085-1094, 2010.

Ren, W., Sorensen, N., “Distributed Coordination Architecture for MultiRobot Formation Control, Robotics and Autonomous Systems,” 56(4), 324-333, 2008.

Ren, W., Beard, R. W., “Distributed Consensus in Multi-vehicle Cooperative Control: Theory and Applications,” Springer-Verlag London Limited, 2008.

S. H. Li, X. Y. Wang, “Finite-time consensus and Collision Avoidance Control algorithms for multiple AUVs,” Automatica, Vol.49, No.11, 3369-3367, 2013.

S. Mastellone, D.M. Stipanovic, C.R. Graunke, K.A. Intlekofer, and M.W. Spong, “Formation control and collision avoidance for multi-agent non-holonomic systems: theory and experiments,” The International Journal of Robotics Research, vol. 27, no. 1, pp. 107, 2008.

Sabir, Djaidja, Wu, Qinghe, “Cooperative Tracking control and Obstacle Avoidance for single-integrator dynamic,” Proceeding of 23nd Chinese Control Conference, 2013.

Scheider, Frack E., Wildermuth, “Development of an Experimental Multi-robot CBRNE Reconnaissance Demonstrator,” Future Security 2012, CCIS 318, pp.400-411, 2012.

Sun, Z., Xia, Y., “Consensus Based Formation Control with Dynamic Role Assignment, Chinese Control and Decision Conference (CCDC)”, 2014.

Vijay, Kumar, “Controlling formations of multiple mobile robots,” IEEE Intemational Conference on Robotics & Automation Leuven, Belgium, 7803-4300, 1999.



  • There are currently no refbacks.