Update RigidBodySimulator.cpp

-fixed ReadRobot to add x,y,theta for every robot