serial.c

   1 #ifdef HAVE_CONFIG_H
   2 # include "config.h"
   3 #endif
   4 #include <string.h>
   5 #include "serial.h"
   6
   7 void serial_init(serializer_t *srl, void *buffer, int size)
   8 {
   9         srl->buffer = srl->cursor = buffer;
  10         srl->bufsize = size;
  11 }
  12
  13 void serial_switch(serializer_t *srl, void *buffer, int size)
  14 {
  15         int used = srl->cursor - srl->buffer;
  16
  17         memcpy(buffer, srl->buffer, used);
  18         srl->buffer = buffer;
  19         srl->bufsize = size;
  20         srl->cursor = buffer + used;
  21 }
  22
  23 int serial_put(serializer_t *srl, const void *item, int size)
  24 {
  25         int left = srl->bufsize - (srl->cursor - srl->buffer);
  26
  27         if (left < size + sizeof(short)) return left - sizeof(short);
  28         *((short *)srl->cursor) = size;
  29         srl->cursor += sizeof(short);
  30         if (size) memcpy(srl->cursor, item, size);
  31         srl->cursor += size;
  32         return size;
  33 }
  34
  35 int serial_get(serializer_t *srl, void *item, int bufsize)
  36 {
  37         int left = srl->bufsize - (srl->cursor - srl->buffer);
  38         short isize = *((short *)srl->cursor);
  39
  40         if (isize > bufsize) return isize;
  41         if (isize + sizeof(short) > left) return -1;
  42         srl->cursor += sizeof(short);
  43         if (isize) memcpy(item, srl->cursor, isize);
  44         srl->cursor += isize;
  45         return isize;
  46 }
  47
  48 int serial_size(serializer_t *srl)
  49 {
  50         return srl->cursor - srl->buffer;
  51 }