Added motor control code for arduino