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

Abstract

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.