133 lines
3.1 KiB
C
133 lines
3.1 KiB
C
#include "wire.h"
|
|
|
|
#include <string.h>
|
|
|
|
void wire_cursor_init(wire_cursor *cursor, const unsigned char *data, size_t length)
|
|
{
|
|
cursor->data = data;
|
|
cursor->length = length;
|
|
cursor->position = 0u;
|
|
cursor->error = WIRE_OK;
|
|
}
|
|
|
|
size_t wire_remaining(const wire_cursor *cursor)
|
|
{
|
|
if (cursor->position > cursor->length) {
|
|
return 0u;
|
|
}
|
|
return cursor->length - cursor->position;
|
|
}
|
|
|
|
int wire_take(wire_cursor *cursor, size_t length, const unsigned char **data)
|
|
{
|
|
if (cursor->error != WIRE_OK) {
|
|
return cursor->error;
|
|
}
|
|
if (length > wire_remaining(cursor)) {
|
|
cursor->error = WIRE_LENGTH_ERROR;
|
|
return cursor->error;
|
|
}
|
|
*data = cursor->data + cursor->position;
|
|
cursor->position += length;
|
|
return WIRE_OK;
|
|
}
|
|
|
|
int wire_u8(wire_cursor *cursor, unsigned *value)
|
|
{
|
|
const unsigned char *data;
|
|
int error = wire_take(cursor, 1u, &data);
|
|
if (error != WIRE_OK) {
|
|
return error;
|
|
}
|
|
*value = data[0];
|
|
return WIRE_OK;
|
|
}
|
|
|
|
int wire_u16(wire_cursor *cursor, uint32_t *value)
|
|
{
|
|
const unsigned char *data;
|
|
int error = wire_take(cursor, 2u, &data);
|
|
if (error != WIRE_OK) {
|
|
return error;
|
|
}
|
|
*value = (uint32_t)data[0] | (uint32_t)data[1] << 8;
|
|
return WIRE_OK;
|
|
}
|
|
|
|
int wire_u32(wire_cursor *cursor, uint32_t *value)
|
|
{
|
|
const unsigned char *data;
|
|
int error = wire_take(cursor, 4u, &data);
|
|
if (error != WIRE_OK) {
|
|
return error;
|
|
}
|
|
uint32_t octets[4];
|
|
unsigned index;
|
|
for (index = 0u; index < 4u; index++) {
|
|
unsigned char octet;
|
|
memcpy(&octet, data + index, 1u);
|
|
octets[index] = octet;
|
|
}
|
|
*value = octets[0] + (octets[1] << 8) + (octets[2] << 16) + (octets[3] << 24);
|
|
return WIRE_OK;
|
|
}
|
|
|
|
int wire_u64(wire_cursor *cursor, uint64_t *value)
|
|
{
|
|
const unsigned char *data;
|
|
int error = wire_take(cursor, 8u, &data);
|
|
uint64_t result = 0u;
|
|
unsigned index;
|
|
if (error != WIRE_OK) {
|
|
return error;
|
|
}
|
|
for (index = 0u; index < 8u; index++) {
|
|
result |= (uint64_t)data[index] << (8u * index);
|
|
}
|
|
*value = result;
|
|
return WIRE_OK;
|
|
}
|
|
|
|
int wire_skip(wire_cursor *cursor, size_t length)
|
|
{
|
|
const unsigned char *ignored;
|
|
return wire_take(cursor, length, &ignored);
|
|
}
|
|
|
|
int wire_slice(wire_cursor *cursor, size_t length, wire_cursor *slice)
|
|
{
|
|
const unsigned char *data;
|
|
int error = wire_take(cursor, length, &data);
|
|
if (error == WIRE_OK) {
|
|
wire_cursor_init(slice, data, length);
|
|
}
|
|
return error;
|
|
}
|
|
|
|
int wire_at_end(const wire_cursor *cursor)
|
|
{
|
|
return cursor->error == WIRE_OK && cursor->position == cursor->length;
|
|
}
|
|
|
|
const char *wire_error_name(int error)
|
|
{
|
|
switch (error) {
|
|
case WIRE_OK:
|
|
return "ok";
|
|
case WIRE_ARGUMENT:
|
|
return "argument";
|
|
case WIRE_CAPACITY:
|
|
return "capacity";
|
|
case WIRE_HEADER_ERROR:
|
|
return "header";
|
|
case WIRE_LENGTH_ERROR:
|
|
return "length";
|
|
case WIRE_CHECKSUM_ERROR:
|
|
return "checksum";
|
|
case WIRE_RECORD_ERROR:
|
|
return "record";
|
|
default:
|
|
return "unknown";
|
|
}
|
|
}
|