stmbl/shared/common.c

27 lines
615 B
C

#include "common.h"
void buff_packet(packet_header_t* p, uint8_t size){
uint8_t nonkey_count = 0;
uint8_t* buf = ((uint8_t*)p) + sizeof(packet_header_t);
for(int i = size - 1; i >= 0; i--){
if(buf[i] == p->start){
buf[i] = nonkey_count;
nonkey_count = 0;
}
else{
nonkey_count++;
}
}
p->key = nonkey_count;
}
void unbuff_packet(packet_header_t* p, uint8_t size){
uint8_t temp;
uint8_t* buf = ((uint8_t*)p) + sizeof(packet_header_t);
for(int j = p->key; j < size;){
temp = buf[j];
buf[j] = p->start;
j += temp + 1;
}
}