Fig. (6) Flow diagram of the robot working principle.