aboutsummaryrefslogtreecommitdiffstats
path: root/serial_link/protocol/byte_stuffer.c
diff options
context:
space:
mode:
Diffstat (limited to 'serial_link/protocol/byte_stuffer.c')
-rw-r--r--serial_link/protocol/byte_stuffer.c52
1 files changed, 27 insertions, 25 deletions
diff --git a/serial_link/protocol/byte_stuffer.c b/serial_link/protocol/byte_stuffer.c
index f9aa02a3f..e5a26c2c2 100644
--- a/serial_link/protocol/byte_stuffer.c
+++ b/serial_link/protocol/byte_stuffer.c
@@ -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;
}
}
}