kalman_robot

uint8 AUTONOMY_SWITCH = 0x20

uint8 MOTOR_SET_WHEELS = 0x40
uint8 MOTOR_GET_TEMPERATURE = 0x42
uint8 MOTOR_SET_ESTOP = 0x43
uint8 MOTOR_GET_ESTOP = 0x45
uint8 MOTOR_GET_WHEELS = 0x4F

uint8 SERVO_SET = 0x50
# uint8 DRILL_DRILL = 0x51
uint8 SAND_STORAGE_CMD = 0x53
# uint8 DRILL_RACK = 0x53
uint8 PH_RAIL = 0x53
uint8 SCALE_REQ = 0x57
uint8 PH_RES = 0x5C
uint8 SCALE_RES = 0x5B
uint8 PH_REQ = 0x59
uint8 LASER_DIST = 0x5A

uint8 TO_UNIVERSAL = 0x5E

uint8 UEUOS_SET_STATE = 0x70
uint8 UEUOS_SET_COLOR = 0x71
uint8 UEUOS_SET_EFFECT = 0x72

uint8 GS_TO_PC = 0x80
uint8 PC_TO_GS = 0x81
uint8 GS_TO_ESP = 0x84
uint8 ESP_TO_GS = 0x85
uint8 GS_TO_ARM = 0x86
uint8 ARM_TO_GS = 0x87
# No ARM_TO_PC and PC_TO_ARM because they are not needed.

uint8 FEED_SET_CAMERA = 0xB1
uint8 FEED_SET_CHANNEL = 0xB2
uint8 FEED_SET_POWER = 0xB3

uint8 ARM_SEND_SPACEMOUSE = 0xB4

uint8 CAM_2DOF_SET = 0xBF

uint8 DRILL_ARM = 0xD0
uint8 DRILL_B_BRIDGE_SET = 0xD1
uint8 DRILL_C_BRIDGE_SET = 0xD2
uint8 DRILL_SET_DRILL_GEAR = 0xD3
uint8 DRILL_AUTONOMY = 0xD5
uint8 DRILL_TELEMETRY = 0xD6

# command number
uint8 cmd

# command data
uint8[] data