mirror of https://github.com/rusefi/bldc.git
98 lines
2.1 KiB
C
98 lines
2.1 KiB
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <time.h>
|
|
|
|
#include "packet.h"
|
|
|
|
const unsigned int rand_prepend = 50;
|
|
static uint8_t buffer[250000];
|
|
static unsigned int write = 0;
|
|
|
|
void send_packet(unsigned char *data, unsigned int len) {
|
|
memcpy(buffer + write, data, len);
|
|
write += len;
|
|
}
|
|
|
|
void process_packet(unsigned char *data, unsigned int len) {
|
|
printf("Packet rx (%03d bytes): %s\r\n", len, (char*)data + rand_prepend);
|
|
}
|
|
|
|
void process_packet_perf(unsigned char *data, unsigned int len) {
|
|
(void)data;
|
|
(void)len;
|
|
}
|
|
|
|
int main(void) {
|
|
packet_init(send_packet, process_packet, 0);
|
|
|
|
srand(104);
|
|
|
|
for (int i = 0;i < 20;i++) {
|
|
char asd[rand_prepend + 100];
|
|
|
|
for (unsigned int j = 0;j < rand_prepend;j++) {
|
|
asd[j] = rand();
|
|
}
|
|
|
|
sprintf(asd + rand_prepend, "Offset: %d Test %d", write, i);
|
|
packet_send_packet((unsigned char*)asd, strlen(asd + rand_prepend) + rand_prepend + 1, 0);
|
|
}
|
|
|
|
// Ability to recover
|
|
unsigned int offsets[] = {121, 1250, 1121, 1122, 1187, 1188, 1189, 1036, 1112, 1264};
|
|
for (unsigned int ofs = 0;ofs < sizeof(offsets) / sizeof(int);ofs++) {
|
|
printf("Decode from offset %d\r\n", offsets[ofs]);
|
|
|
|
//packet_reset(0);
|
|
for(unsigned int i = offsets[ofs];i < write;i++) {
|
|
packet_process_byte(buffer[i], 0);
|
|
}
|
|
|
|
printf("\r\n");
|
|
}
|
|
|
|
// Corruption
|
|
printf("Corruption Test\r\n");
|
|
buffer[12] = 91;
|
|
buffer[13] = 0xFF;
|
|
buffer[14] = 0;
|
|
buffer[15] = 221;
|
|
buffer[800] = 0;
|
|
buffer[345] = 0xFF;
|
|
buffer[1200]++;
|
|
buffer[1342]++;
|
|
for(unsigned int i = 0;i < write;i++) {
|
|
packet_process_byte(buffer[i], 0);
|
|
}
|
|
|
|
// Performance
|
|
printf("\r\nPerformance Test\r\n");
|
|
packet_init(send_packet, process_packet_perf, 0);
|
|
|
|
srand(104);
|
|
write = 0;
|
|
unsigned char asd[500];
|
|
for (unsigned int i = 0;i < sizeof(asd);i++) {
|
|
asd[i] = rand();
|
|
}
|
|
|
|
clock_t start, end;
|
|
double cpu_time_used;
|
|
|
|
start = clock();
|
|
for (int i = 0;i < 1e6;i++) {
|
|
packet_send_packet(asd, sizeof(asd), 0);
|
|
for (unsigned int j = 0;j < write;j++) {
|
|
packet_process_byte(buffer[j], 0);
|
|
}
|
|
write = 0;
|
|
}
|
|
end = clock();
|
|
cpu_time_used = ((double) (end - start)) / CLOCKS_PER_SEC;
|
|
|
|
printf("Time: %.3f s\r\n", cpu_time_used);
|
|
|
|
return 0;
|
|
}
|