134 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 result = 0u;
unsigned index;
/* A cursor describes octets; assemble the protocol integer. */
for (index = 0u; index < 4u; index++) {
uint32_t octet = data[index];
uint32_t shift = index * 8u;
result |= octet << shift;
}
*value = result;
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";
}
}