Open Access Open Access  Restricted Access Subscription Access

Formation Control of Humanoid Robots with Obstacle & Collision Avoidance Inspired by SFM

Ali Sadiyoko, Riyanto Trilaksono Bambang, Kusprasapta Mutijarsa, Widyawardana Adiprawita


This paper presents a new design for formation control on a group of autonomous humanoid robots with obstacle and collision avoidance ability that inspired by human walking behavior in a pedestrian crowd. This human walking behavior model is known as Social Force Model (SFM) and has been widely used to predict individual movement in a crowd in many variety of situation. We combine consensus algorithm with virtual structure approach for formation control and SFM for obstacle and collision avoidance. In this research, we induced some factors in SFM into consensus equation and then implemented into a group of humanoid robots. The aim of the integration is to create a group of robots that are capable of carrying out its collective tasks while still able to maintain its safety. The use of perception effect, distinct obstacle and collision avoidance function on the algorithm will differentiate algorithm with the others. The attractive feature of this new design is the various behaviors of robots to go back to their initial formation after they avoid obstacles. In the case of robot is trapped in a crowded situation (singularity condition), robot will still trying to look a new position, until it find a condition that allow him to move forward. We verify the proposed algorithm by some simulations and experiments.

Full Text:



S. Mastellone, D.M. Stipanović, C.R. Graunke, K.A. Intlekofer, and M.W. Spong, “Formation control and collision avoidance for multiagent non-holonomic systems: theory and experiments”, Int. J. Rob. Res. 27, 1 (January 2008), pp. 107-126.

M. Casini, A. Garulli, A. Giannitrapani and A. Vicino, “A LEGO Mindstorms multi-robot setup in the Automatic Control Telelab”, Proc. of the 18th World Congress of the International Federation of Automatic Control (IFAC2011), 2011.

R. Olfati-Saber and S. Richard, “Flocking with obstacle avoidance: cooperation with limited communication in mobile networks”, Proc. of the 42nd IEEE Conf. On Decision and Control. Maui, USA. 2003. p. 2022-2028.

C.W. Reynolds,. “Flocks, herds and schools : a distributed behavioral model”, Computer Graphics, 21(4), 25-34, 1987.

M. Hoy, A.S. Matveev and A.V. Savkin. Collision free cooperative navigation of multiple wheeled robots in unknown cluttered environments. Robot. Auton. Syst. 60, 10 (October 2012).1253-1266.

J.H. Jung, S Park, S.L. Kim, “Multi-robot path finding with wireless multihop communications”. IEEE Communication Magazine, July 2010.

Ballard, L.; Wei Ren, "Dynamic formation algorithms and experiments", Proc. On 4th Industrial Electronics and Applications (ICIEA 2009), 25-27 May 2009, pp.1871,1876.

W. Ren and R.W. Beard. “Distributed consensus in multi-vehicle cooperative control: theory and applications”, Springer-Verlag, London,

D. Helbing, and P. Molnár, “Social force model for pedestrian dynamics”, Physical Review E 51, 1995, pp. 4282–4286.

D. Helbing, I. Farkas, T. Vicsek, “Simulating dynamical features of escape panic”, Nature 407 (6803), 2000, pp. 487–490.

D. Helbing, A. Johansson and H. Z. Al-Abideen, “The dynamics of crowd disasters: an empirical study”, Physical Review E 75, 2007.

T.I. Lakoba, D.J. Kaup and N.M. Finkelstein, “Modification of the Helbing-Molnar-Farkas-Vicsek Social Force Model for pedestrian dynamics”. SIMULATION,81 (5), 2005, pp. 339-352.

D.J. Kaup, T.L. Clarke, R. Oleson and L.C. Malone, “Crowd dynamics

simulation research”, Proc. of 16th Conference on Behavior Representation in Modeling and Simulation (BRIMS), 2007, pp. 173-180.

A. Sadiyoko, B.R. Trilaksono and K. Mutijarsa, “Human crowd dynamics using social force model”, Transl. Proc. of National Conference & Workshop on Modeling & System Design, Bandung- Indonesia, 2011, pp. 1-6.

A. Sadiyoko, Oetomo, H. Septanto, B.R. Trilaksono, K. Mutijarsa and A. Syaichu-Rohman, “Experimental study of consensus algorithm on a group of humanoid robots”, Proc. of the 8th International Conference on

Intelligent Unmanned Systems (ICIUS 2012), Singapore, 2012.

A. Sadiyoko, H. Septanto, O. Soedjana, O., B.R. Trilaksono and K.

Mutijarsa, ”Implementation of consensus algorithm on a group of humanoid robots with varying network topologies”, Int. J. on Electrical Engineering and Informatics, Vol. 6, No. 4, December 2014, pp. 755-768.

A. Sadiyoko, B.R. Trilaksono, K. Mutijarsa and W. Adiprawita, “Consensus algorithm for obstacle avoidance and formation control”, Proceedings of the 10th Asian Control Conference (ASCC 2015), Kota Kinabalu, Malaysia, 2015, pp. 880-885.

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, pp. 699-707.

A. Sadiyoko, “Nao: robots formation control, obstacle & collision avoidance”,



  • There are currently no refbacks.