shrub/vere/newt.c

/* vere/newt.c
**
**  implements noun blob messages with trivial framing.
**
**  a message is a 64-bit little-endian byte count, followed
**  by the indicated number of bytes.  the bytes are the
**  the ++cue of of a noun.
**
**  the implementation is relatively inefficient and could
**  lose a few copies, mallocs, etc.
*/
#include <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <unistd.h>
#include <setjmp.h>
#include <gmp.h>
#include <sigsegv.h>
#include <stdint.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <uv.h>
#include <errno.h>
#include <curses.h>
#include <termios.h>
#include <term.h>

#include "all.h"
#include "vere/vere.h"

/* _newt_consume(): advance buffer processing.
*/
static void
_newt_consume(u3_moat* mot_u)
{
  /*  process stray bytes, trying to create a new message
  **  or add a block to an existing one.
  */
  while ( 1 ) {
    if ( mot_u->rag_y ) {
      /* if there is a live message, add a block to the queue.
      */
      if ( mot_u->mes_u ) {
        u3_meat* met_u;

        /* create block
        */
        met_u = c3_malloc(mot_u->len_d + (c3_d) sizeof(u3_meat));
        met_u->nex_u = 0;
        met_u->len_d = mot_u->len_d;
        memcpy(met_u->hun_y, mot_u->rag_y, mot_u->len_d);

#if 0
          fprintf(stderr, 
  "newt: %d: create: msg %p, new block %p, len %lld, has %lld, needs %lld\r\n",
              getpid(),
              mot_u->mes_u,
              met_u,
              met_u->len_d,
              mot_u->mes_u->has_d,
              mot_u->mes_u->len_d);
#endif
        /* enqueue block
        */
        if ( !mot_u->mes_u->meq_u ) {
          mot_u->mes_u->meq_u = mot_u->mes_u->qem_u = met_u;
        }
        else {
          mot_u->mes_u->qem_u->nex_u = met_u;
          mot_u->mes_u->qem_u = met_u;
        }
        mot_u->mes_u->has_d += met_u->len_d;

        /* free consumed stray bytes
        */
        c3_free(mot_u->rag_y);
        mot_u->len_d = 0;
        mot_u->rag_y = 0;
      }
      else {
        /* no message, but enough stray bytes to fill in 
        ** a length; collect them and create a message.
        */
        if ( mot_u->len_d >= 8ULL ) {
          c3_d nel_d = 0;

          nel_d |= ((c3_d) mot_u->rag_y[0]) << 0ULL;
          nel_d |= ((c3_d) mot_u->rag_y[1]) << 8ULL;
          nel_d |= ((c3_d) mot_u->rag_y[2]) << 16ULL;
          nel_d |= ((c3_d) mot_u->rag_y[3]) << 24ULL;
          nel_d |= ((c3_d) mot_u->rag_y[4]) << 32ULL;
          nel_d |= ((c3_d) mot_u->rag_y[5]) << 40ULL;
          nel_d |= ((c3_d) mot_u->rag_y[6]) << 48ULL;
          nel_d |= ((c3_d) mot_u->rag_y[7]) << 56ULL;
#if 0
          fprintf(stderr, "newt: %d: parsed length %lld\r\n",
                          getpid(),
                          nel_d);
#endif
          mot_u->len_d -= 8ULL;

          mot_u->mes_u = c3_malloc(sizeof(u3_mess));
          mot_u->mes_u->len_d = nel_d;
          mot_u->mes_u->has_d = 0;
          mot_u->mes_u->meq_u = mot_u->mes_u->qem_u = 0;

          if ( !mot_u->len_d ) {
            c3_free(mot_u->rag_y);
            mot_u->rag_y = 0;
          }
          else {
            /* remove consumed length from stray bytes
            */
            c3_y* buf_y = c3_malloc(mot_u->len_d); 
            
            memcpy(buf_y, mot_u->rag_y + 8, mot_u->len_d);

            c3_free(mot_u->rag_y);
            mot_u->rag_y = buf_y;

            /* remaining bytes will be installed as message meat
            */
            continue;
          }
        }
      }
    }

    /*  check for message completions
    */
    if ( mot_u->mes_u && (mot_u->mes_u->has_d >= mot_u->mes_u->len_d) ) {
      c3_d     len_d = mot_u->mes_u->len_d;
      c3_y*    buf_y = c3_malloc(len_d);
      c3_d     pat_d = 0;
      u3_meat* met_u;

      /* we should have just cleared this
      */
      c3_assert(!mot_u->rag_y);
      c3_assert(!mot_u->len_d);

      /* collect queue blocks, cleaning them up; return any spare meat
      ** to the rag.
      */
      {
        met_u = mot_u->mes_u->meq_u;
        while ( met_u && (pat_d < len_d) ) {
          u3_meat* nex_u = met_u->nex_u;
          c3_d     end_d = (pat_d + met_u->len_d);
          c3_d     eat_d;
          c3_d     rem_d;

          eat_d = c3_min(len_d, end_d) - pat_d;
          memcpy(buf_y + pat_d, met_u->hun_y, eat_d);
          pat_d += eat_d;

          rem_d = (met_u->len_d - eat_d);
          if ( rem_d ) {
            mot_u->rag_y = c3_malloc(rem_d);
            memcpy(mot_u->rag_y, met_u->hun_y + eat_d, rem_d);
            mot_u->len_d = rem_d;

            /* one: unless we got a bad length, this has to be the last
            ** block in the message.
            **
            ** two: bad data on a newt channel can cause us to assert.
            ** that's actually the right thing for a private channel.
            */
            c3_assert(0 == nex_u);
          }
          c3_free(met_u);
          met_u = nex_u;
        }
        c3_assert(pat_d == len_d);

        /* clear the message
        */
        c3_free(mot_u->mes_u);
        mot_u->mes_u = 0;
      }

      /* build and send the object
      */
      {
        u3_noun mat = u3i_bytes((c3_w) len_d, buf_y);

        mot_u->pok_f(mot_u->vod_p, mat);
      }

      /* continue; spare meat may need processing
      */
      continue;
    }

    /* nothing happening, await next event
    */
    break;
  }
}

/* _raft_alloc(): libuv-style allocator for raft.
*/
static void
_newt_alloc(uv_handle_t* had_u, 
            size_t len_i,
            uv_buf_t* buf_u)
{
  void* ptr_v = c3_malloc(len_i);

  *buf_u = uv_buf_init(ptr_v, len_i);
}

/* _newt_read_cb(): stream input callback.
*/
void
_newt_read_cb(uv_stream_t*    str_u,
              ssize_t         len_i,
              const uv_buf_t* buf_u)
{
  c3_d     len_d = (c3_d) len_i;
  u3_moat* mot_u = (void *)str_u;

  if ( UV_EOF == len_i ) {
    fprintf(stderr, "newt: %d: stream closed\r\n", getpid());
    uv_read_stop(str_u);
    mot_u->bal_f(mot_u->vod_p, "stream closed");
  }
  else {
#if 0
    fprintf(stderr, "newt: %d: read %ld\r\n", getpid(), len_i);
#endif

    if ( mot_u->rag_y ) {
      mot_u->rag_y = c3_realloc(mot_u->rag_y, mot_u->len_d + len_d);
      memcpy(mot_u->rag_y + mot_u->len_d, buf_u->base, len_d);
      c3_free(buf_u->base);
    }
    else {
      mot_u->rag_y = (c3_y *)buf_u->base;
      mot_u->len_d = len_d;
    }
    _newt_consume(mot_u);
  }
}

/* u3_newt_read(): start stream reading.
*/
void
u3_newt_read(u3_moat* mot_u)
{
  c3_i err_i;

  mot_u->mes_u = 0;
  mot_u->len_d = 0;
  mot_u->rag_y = 0;

  err_i = uv_read_start((uv_stream_t*) &mot_u->pyp_u,
                        _newt_alloc,
                        _newt_read_cb);

  if ( err_i != 0 ) {
    mot_u->bal_f(mot_u, uv_strerror(err_i));
  }
}

/* write request for newt
*/
  struct _u3_write_t {
    uv_write_t wri_u;
    u3_mojo*   moj_u;
    void*      vod_p;
    c3_y*      buf_y;
  };

/* _newt_write_cb(): generic write callback.
*/
static void
_newt_write_cb(uv_write_t* wri_u, c3_i sas_i)
{
  struct _u3_write_t* req_u = (struct _u3_write_t*)wri_u;
  void*               vod_p = req_u->vod_p;
  u3_mojo*            moj_u = req_u->moj_u;

  free(req_u->buf_y);
  free(req_u);

  if ( 0 != sas_i ) {
    fprintf(stderr, "newt: bad write %d\r\n", sas_i);
    moj_u->bal_f(vod_p, uv_strerror(sas_i));
  }
}

/* u3_newt_write(): write atom to stream; free atom.
*/
void
u3_newt_write(u3_mojo* moj_u,
              u3_atom  mat,
              void*    vod_p)
{
  c3_w                len_w = u3r_met(3, mat);
  c3_y*               buf_y = c3_malloc(len_w + 8);
  struct _u3_write_t* req_u = c3_malloc(sizeof(*req_u));
  uv_buf_t            buf_u;
  c3_i                err_i;

  /* write header; c3_d is futureproofing
  */
  buf_y[0] = ((len_w >> 0) & 0xff);
  buf_y[1] = ((len_w >> 8) & 0xff);
  buf_y[2] = ((len_w >> 16) & 0xff);
  buf_y[3] = ((len_w >> 24) & 0xff);
  buf_y[4] = buf_y[5] = buf_y[6] = buf_y[7] = 0;
  u3r_bytes(0, len_w, buf_y + 8, mat);
  u3z(mat);

  req_u->moj_u = moj_u;
  req_u->buf_y = buf_y;
  buf_u.base = (c3_c*) buf_y;
  buf_u.len = len_w + 8;

#if 0
  fprintf(stderr, "newt: %d: write %d\n", getpid(), len_w + 8);
#endif
  if ( 0 != (err_i = uv_write((uv_write_t*)req_u,
                              (uv_stream_t*)&moj_u->pyp_u,
                              &buf_u,
                              1,
                              _newt_write_cb)) )
  {
    moj_u->bal_f(moj_u, uv_strerror(err_i));
  }
}