Updated the code to integrate with the simulation program of robots