Figure 1: Overall Block diagram of the robot