labcomm_thr_reader_writer.c

#include <errno.h>
#include <unistd.h>
#include "labcomm.h"
#include "ThrottleDrv/throttle_drv.h"

#define BUFFER_SIZE 2048

int labcomm_thr_reader(labcomm_reader_t *r, labcomm_reader_action_t action)
{
  int result = -EINVAL;
  struct thr_chn_t *ctx = r->context;

  switch (action)
  {
    case labcomm_reader_alloc:
    {
      r->data = malloc(BUFFER_SIZE);
      if (r->data)
      {
        r->data_size = BUFFER_SIZE;
        result = r->data_size;
      }
      else
      {
        r->data_size = 0;
        result = -ENOMEM;
      }
      r->count = 0;
      r->pos = 0;
    }
    break;

    case labcomm_reader_start:
    case labcomm_reader_continue:
    {
      if (r->pos < r->count)
      {
        result = r->count - r->pos;
      }
      else
      {
        int err;
        r->pos = 0;
        err = thr_read(ctx, r->data, r->data_size);
        if (err <= 0)
        {
          r->count = 0;
          result = -1;
        } else
        {
          r->count = err;
          result = r->count - r->pos;
        }
      }
    }
    break;

    case labcomm_reader_end:
    {
      result = 0;
    }
    break;

    case labcomm_reader_free:
    {
      free(r->data);
      r->data = 0;
      r->data_size = 0;
      r->count = 0;
      r->pos = 0;