Robot Simulation and Control