serial.c

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