Fixed wrong number of joint names in moveRobotToStartPos
Fixed all errors in Gazebo