Add runMotorDZ function
New robot config and functions