drashna/qmk_firmware
1
0
Fork 0
Code Activity Actions

Add byte stuffing send support for large frames

Browse source
This commit is contained in:
Fred Sundvik 2016-02-14 19:56:22 +02:00
parent 2f3ea76428
commit 6956c177da
2 changed files with 72 additions and 5 deletions
Download patch file Download diff file Expand all files Collapse all files

21
serial_link/protocol/byte_stuffer.c
View file

@ -25,6 +25,7 @@ SOFTWARE.
#include "protocol/byte_stuffer.h"
#include "protocol/frame_validator.h"
#include "protocol/physical.h"
#include <stdio.h>
// This implements the "Consistent overhead byte stuffing protocol"
// https://en.wikipedia.org/wiki/Consistent_Overhead_Byte_Stuffing
@ -103,19 +104,29 @@ static void send_block(uint8_t* start, uint8_t* end, uint8_t num_non_zero) {
void send_frame(uint8_t* data, uint16_t size) {
const uint8_t zero = 0;
if (size > 0) {
uint8_t num_non_zero = 1;
uint16_t num_non_zero = 1;
uint8_t* end = data + size;
uint8_t* start = data;
while (data < end) {
if (*data == 0) {
if (num_non_zero == 0xFF) {
// There's more data after big non-zero block
// So send it, and start a new block
send_block(start, data, num_non_zero);
start = data + 1;
start = data;
num_non_zero = 1;
}
else {
num_non_zero++;
if (*data == 0) {
// A zero encountered, so send the block
send_block(start, data, num_non_zero);
start = data + 1;
num_non_zero = 1;
}
else {
num_non_zero++;
}
++data;
}
++data;
}
send_block(start, data, num_non_zero);
send_data(&zero, 1);