lucysrausch/hoverboard-firmware-hack
1
0
Fork 1
mirror of https://github.com/lucysrausch/hoverboard-firmware-hack.git synced 2025-06-24 22:41:32 +02:00
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #132 from hexagon5un/simple_serial_framing

Browse Source 
minimalistic framing for UART command
This commit is contained in:
NiklasFauth
2019-12-18 22:08:10 +01:00
committed by GitHub
parent 2569b22640 3ee11fc248
commit 79dd130028
2 changed files with 20 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

1
Inc/config.h
View File

@ -9,6 +9,7 @@
#define DELAY_IN_MAIN_LOOP 5 // in ms. default 5. it is independent of all the timing critical stuff. do not touch if you do not know what you are doing.
#define TIMEOUT 5 // number of wrong / missing input commands before emergency off
#define START_FRAME 0xAAAA // serial command start-of-frame magic word
// ############################### GENERAL ###############################

29
Src/main.c
View File

@ -41,9 +41,10 @@ int cmd2;
int cmd3;
typedef struct{
int16_t steer;
int16_t speed;
//uint32_t crc;
uint16_t start_of_frame;
int16_t steer;
int16_t speed;
uint16_t checksum;
} Serialcommand;
volatile Serialcommand command;
@ -157,7 +158,7 @@ int main(void) {
#ifdef CONTROL_SERIAL_USART2
UART_Control_Init();
HAL_UART_Receive_DMA(&huart2, (uint8_t *)&command, 4);
HAL_UART_Receive_DMA(&huart2, (uint8_t *)&command, sizeof(command));
#endif
#ifdef DEBUG_I2C_LCD
@ -218,12 +219,20 @@ int main(void) {
timeout = 0;
#endif
#ifdef CONTROL_SERIAL_USART2
cmd1 = CLAMP((int16_t)command.steer, -1000, 1000);
cmd2 = CLAMP((int16_t)command.speed, -1000, 1000);
timeout = 0;
#endif
#ifdef CONTROL_SERIAL_USART2
if (command.start_of_frame == START_FRAME &&
command.checksum ==(uint16_t)(START_FRAME ^ command.steer ^ command.speed)) {
cmd1 = CLAMP((int16_t)command.steer, -1000, 1000);
cmd2 = CLAMP((int16_t)command.speed, -1000, 1000);
} else { // restart DMA to hopefully get back in sync
// Try a periodic reset
if (main_loop_counter % 25 == 0) {
HAL_UART_DMAStop(&huart2);
HAL_UART_Receive_DMA(&huart2, (uint8_t *)&command, sizeof(command));
}
}
timeout = 0;
#endif
#ifdef CONTROL_MOTOR_TEST
if (motor_test_direction == 1) cmd2 += 1;