drashna/qmk_firmware
1
0
Fork 0
Code Activity Actions

Hide the byte stuffer state inside it

Browse source
This commit is contained in:
Fred Sundvik 2016-02-17 09:07:38 +02:00
parent 8d50880686
commit 419908e5ef
3 changed files with 117 additions and 117 deletions
Download patch file Download diff file Expand all files Collapse all files

52
serial_link/protocol/byte_stuffer.c
View file

@ -40,56 +40,58 @@ typedef struct byte_stuffer_state {
uint8_t data[MAX_FRAME_SIZE];
}byte_stuffer_state_t;
void init_byte_stuffer_state(byte_stuffer_state_t* state) {
state->next_zero = 0;
state->data_pos = 0;
state->long_frame = false;
static byte_stuffer_state_t state;
void init_byte_stuffer(void) {
state.next_zero = 0;
state.data_pos = 0;
state.long_frame = false;
}
void recv_byte(byte_stuffer_state_t* state, uint8_t data) {
void recv_byte(uint8_t data) {
// Start of a new frame
if (state->next_zero == 0) {
state->next_zero = data;
state->long_frame = data == 0xFF;
state->data_pos = 0;
if (state.next_zero == 0) {
state.next_zero = data;
state.long_frame = data == 0xFF;
state.data_pos = 0;
return;
}
state->next_zero--;
state.next_zero--;
if (data == 0) {
if (state->next_zero == 0) {
if (state.next_zero == 0) {
// The frame is completed
if (state->data_pos > 0) {
validator_recv_frame(state->data, state->data_pos);
if (state.data_pos > 0) {
validator_recv_frame(state.data, state.data_pos);
}
}
else {
// The frame is invalid, so reset
init_byte_stuffer_state(state);
init_byte_stuffer();
}
}
else {
if (state->data_pos == MAX_FRAME_SIZE) {
if (state.data_pos == MAX_FRAME_SIZE) {
// We exceeded our maximum frame size
// therefore there's nothing else to do than reset to a new frame
state->next_zero = data;
state->long_frame = data == 0xFF;
state->data_pos = 0;
state.next_zero = data;
state.long_frame = data == 0xFF;
state.data_pos = 0;
}
else if (state->next_zero == 0) {
if (state->long_frame) {
else if (state.next_zero == 0) {
if (state.long_frame) {
// This is part of a long frame, so continue
state->next_zero = data;
state->long_frame = data == 0xFF;
state.next_zero = data;
state.long_frame = data == 0xFF;
}
else {
// Special case for zeroes
state->next_zero = data;
state->data[state->data_pos++] = 0;
state.next_zero = data;
state.data[state.data_pos++] = 0;
}
}
else {
state->data[state->data_pos++] = data;
state.data[state.data_pos++] = data;
}
}
}