fxi
This commit is contained in:
parent
91c4500d82
commit
b81c903292
|
@ -124,17 +124,17 @@ void Handlers::motorSteerControl(BLECharacteristic &characteristic, uint8_t *pac
|
||||||
void Handlers::motorRotateControl(BLECharacteristic &characteristic, uint8_t *packet)
|
void Handlers::motorRotateControl(BLECharacteristic &characteristic, uint8_t *packet)
|
||||||
{
|
{
|
||||||
uint8_t direction = packet[3];
|
uint8_t direction = packet[3];
|
||||||
uint8_t time = packet[4];
|
uint8_t speed = packet[4];
|
||||||
Serial.println("CMD_MOTOR_ROTATE_CONTROL, direction: " + String(direction) + ", time: " + String(time));
|
Serial.println("CMD_MOTOR_ROTATE_CONTROL, direction: " + String(direction) + ", speed: " + String(speed));
|
||||||
// 顺时针
|
// 顺时针
|
||||||
if (direction == 0x00)
|
if (direction == 0x00)
|
||||||
{
|
{
|
||||||
MotorController::rotate(ROTATE_CLOCKWISE, 255);
|
MotorController::rotate(ROTATE_CLOCKWISE, speed);
|
||||||
}
|
}
|
||||||
// 逆时针
|
// 逆时针
|
||||||
else if (direction == 0x01)
|
else if (direction == 0x01)
|
||||||
{
|
{
|
||||||
MotorController::rotate(ROTATE_ANTICLOCKWISE, 255);
|
MotorController::rotate(ROTATE_ANTICLOCKWISE, speed);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -1,6 +1,7 @@
|
||||||
#include "mode.h"
|
#include "mode.h"
|
||||||
|
|
||||||
ModeType Mode::mode = ModeType::MODE_MANUAL_CONTROL;
|
ModeType Mode::mode = ModeType::MODE_MANUAL_CONTROL;
|
||||||
|
ModeType Mode::lastMode = ModeType::MODE_MANUAL_CONTROL;
|
||||||
|
|
||||||
void Mode::processDeviceMode()
|
void Mode::processDeviceMode()
|
||||||
{
|
{
|
||||||
|
|
Loading…
Reference in New Issue