Added simplified functions for motor control