message: Add HALT command
diff: @@ -188,6 +188,10 @@ void motor_parse_cmd(uint8_t* buffer, int len, SerialPrintf_t response_interface
  };
  }
  }
  + } else if (buffer[0] == 'h'){ // HALT
  + for(int i = 0; i < num_motors; i++){
  + set_vel_setpoint(&motors[i], 0.0f, 0.0f);
  + }
  } else if (buffer[0] == 's') { // SET
  // s <0:float,1:int,2:bool,3:uint16> index value
  int type = 0;
  