71 lines
2.2 KiB
C
71 lines
2.2 KiB
C
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
#include "trikke_ble_protocol.h"
|
|
#include "trikke_protocol.h"
|
|
|
|
static int fail(int code, const char *message)
|
|
{
|
|
fprintf(stderr, "BLE protocol fixture failure %d: %s\n", code, message);
|
|
return code;
|
|
}
|
|
|
|
static void put_u16_le(uint8_t *output, uint16_t value)
|
|
{
|
|
output[0] = (uint8_t)value;
|
|
output[1] = (uint8_t)(value >> 8);
|
|
}
|
|
|
|
static void put_u32_le(uint8_t *output, uint32_t value)
|
|
{
|
|
output[0] = (uint8_t)value;
|
|
output[1] = (uint8_t)(value >> 8);
|
|
output[2] = (uint8_t)(value >> 16);
|
|
output[3] = (uint8_t)(value >> 24);
|
|
}
|
|
|
|
int main(void)
|
|
{
|
|
uint8_t packet[TRIKKE_WIRE_HEADER_SIZE + 16] = {0};
|
|
memcpy(packet, "TRK1", 4);
|
|
packet[4] = TRIKKE_WIRE_VERSION;
|
|
packet[6] = TRIKKE_WIRE_HEADER_SIZE;
|
|
put_u16_le(packet + 10, 16);
|
|
put_u32_le(packet + 12, 0x78563412);
|
|
for (size_t i = TRIKKE_WIRE_HEADER_SIZE; i < sizeof(packet); ++i) {
|
|
packet[i] = (uint8_t)i;
|
|
}
|
|
|
|
uint8_t fragment[32] = {0};
|
|
size_t size = trikke_ble_encode_fragment(
|
|
fragment, sizeof(fragment), packet, sizeof(packet), 0, 20);
|
|
if (size != 20 || memcmp(fragment, "\x12\x34\x56\x78\x00\x00\x34\x00", 8) != 0 ||
|
|
memcmp(fragment + 8, packet, 12) != 0) {
|
|
return fail(1, "first fragment envelope");
|
|
}
|
|
|
|
size = trikke_ble_encode_fragment(
|
|
fragment, sizeof(fragment), packet, sizeof(packet), 48, 20);
|
|
if (size != 12 || fragment[4] != 48 ||
|
|
memcmp(fragment + 8, packet + 48, 4) != 0) {
|
|
return fail(2, "last fragment envelope");
|
|
}
|
|
|
|
uint8_t ack[TRIKKE_BLE_ACK_SIZE] = {'A', 'C', 'K', '1', 0x12, 0x34, 0x56, 0x78};
|
|
uint32_t sequence = 0;
|
|
if (!trikke_ble_decode_ack(ack, sizeof(ack), &sequence) ||
|
|
sequence != 0x78563412) {
|
|
return fail(3, "ACK decoding");
|
|
}
|
|
ack[0] = 'N';
|
|
if (trikke_ble_decode_ack(ack, sizeof(ack), &sequence) ||
|
|
trikke_ble_encode_fragment(fragment, sizeof(fragment), packet,
|
|
sizeof(packet), sizeof(packet), 20) != 0 ||
|
|
trikke_ble_encode_fragment(fragment, sizeof(fragment), packet,
|
|
sizeof(packet), 0, 8) != 0) {
|
|
return fail(4, "invalid input rejection");
|
|
}
|
|
return 0;
|
|
}
|