Added motor control functions
Added motor control functions