Changed parameters (motor control has the new parameters measured in odometry);  Created robot movement simulator :). Added command to check if motor controller is waiting for a command. (inWaing)