Testing and fixing robotMove and robotRotate