+
+ motor_num = cur_motor[0]%10;
+ motor_num *= 10;
+ motor_num += cur_motor[1];
+ switch (dispense_motor(motor_num)) {
+ case MOTOR_HOME_FAIL:
+ set_msg(" HOME FAIL ");
+ break;
+ case MOTOR_CURRENT_FAIL:
+ set_msg(" OVER CRNT ");
+ break;
+ case MOTOR_SUCCESS:
+ set_msg("THANK YOU");
+ break;
+ default:
+ set_msg("ERRRRRRRR?");
+ break;
+ }
+