@@ -55,7 +55,7 @@ static const stm32_usart_t fsUSART = {
55
55
.rxDMA_Channel = FLYSKY_HALL_DMA_Channel,
56
56
};
57
57
58
- DEFINE_STM32_SERIAL_PORT (FSGimbal, fsUSART, HALLSTICK_BUFF_SIZE, 0 );
58
+ DEFINE_STM32_SERIAL_PORT (FSGimbal, fsUSART, HALLSTICK_BUFF_SIZE, HALLSTICK_CMD_BUFF_SIZE );
59
59
60
60
static const etx_serial_port_t _fs_gimbal_serial_port = {
61
61
.name = " gimbals" ,
@@ -66,8 +66,6 @@ static const etx_serial_port_t _fs_gimbal_serial_port = {
66
66
67
67
static STRUCT_HALL HallProtocol = { 0 };
68
68
69
- static uint8_t _fs_hall_command[8 ] __DMA;
70
-
71
69
static void * _fs_usart_ctx = nullptr ;
72
70
73
71
static volatile bool _fs_gimbal_detected;
@@ -156,18 +154,18 @@ void _fs_send_cmd(uint8_t id, uint8_t payload)
156
154
return ;
157
155
}
158
156
159
- _fs_hall_command [0 ] = FLYSKY_HALL_PROTOLO_HEAD;
160
- _fs_hall_command [1 ] = id;
161
- _fs_hall_command [2 ] = 0x01 ;
162
- _fs_hall_command [3 ] = payload;
157
+ FSGimbal_TXBuffer [0 ] = FLYSKY_HALL_PROTOLO_HEAD;
158
+ FSGimbal_TXBuffer [1 ] = id;
159
+ FSGimbal_TXBuffer [2 ] = 0x01 ;
160
+ FSGimbal_TXBuffer [3 ] = payload;
163
161
164
- unsigned short crc = crc16 (CRC_1021, _fs_hall_command , 4 , 0xffff );
162
+ unsigned short crc = crc16 (CRC_1021, FSGimbal_TXBuffer , 4 , 0xffff );
165
163
166
- _fs_hall_command [4 ] = crc & 0xff ;
167
- _fs_hall_command [5 ] = crc >>8 & 0xff ;
164
+ FSGimbal_TXBuffer [4 ] = crc & 0xff ;
165
+ FSGimbal_TXBuffer [5 ] = crc >>8 & 0xff ;
168
166
169
167
_fs_gimbal_cmd_finished = false ;
170
- STM32SerialDriver.sendBuffer (_fs_usart_ctx, _fs_hall_command , 6 );
168
+ STM32SerialDriver.sendBuffer (_fs_usart_ctx, FSGimbal_TXBuffer , 6 );
171
169
// TRACE("Flysky Gimbal: Sent command, id = %d, payload = %d", id, payload);
172
170
}
173
171
0 commit comments