minidol/lib/dol.c

   1 /* DOL Block Implementation */
   2
   3 #include <stdio.h>
   4 #include <dol.h>
   5 #include "ports.h"
   6
   7 /* DOL support functions
   8  * ===================================================================== */
   9 int DOL_read(void *port, void *buf, int len, DOLProcess *p)
  10 {
  11         port_t *pp = get_port(port);
  12         if(!pp || !pp->read) return 0;
  13
  14         return(pp->read(buf, len));
  15 }
  16
  17 int DOL_write(void *port, void *buf, int len, DOLProcess *p)
  18 {
  19         port_t *pp = get_port(port);
  20         if(!pp || !pp->write) return 0;
  21
  22         return(pp->write(buf, len));
  23 }
  24
  25 int DOL_rtest(void *port, int len, DOLProcess *p)
  26 {
  27         /* check if channel contains at least 'len' bytes */
  28         port_t *pp = get_port(port);
  29         if(!pp || !pp->level) return 0;
  30
  31         int level = pp->level();
  32         return (level >= len) ? 1 : 0;
  33 }
  34
  35 int DOL_wtest(void *port, int len, DOLProcess *p)
  36 {
  37         /* check if channel has space for at least 'len' bytes */
  38         port_t *pp = get_port(port);
  39         if(!pp || !pp->level) return 0;
  40
  41         int level = pp->level();
  42         return (level < (pp->size() - len)) ? 1 : 0;
  43 }
  44
  45 void DOL_detach(DOLProcess *p)
  46 {
  47         p->wptr->active = 0;
  48         return;
  49 }
  50
  51 int DOL_get_index(int dim, DOLProcess *p)
  52 {
  53         if((dim < 0) || (dim > 4)) return(-1);
  54
  55         return(p->wptr->instance[dim]);
  56 }
  57
  58 char* DOL_create_port(char* port, char* base, int ndim, int index0, int range0,
  59         int index1, int range1, int index2, int range2, int index3, int range3)
  60 {
  61         /* hang on invalid input */
  62         if(range0 && (index0 >= range0)) while(1);
  63         if(range1 && (index1 >= range1)) while(1);
  64         if(range2 && (index2 >= range2)) while(1);
  65         if(range3 && (index3 >= range3)) while(1);
  66
  67         switch(ndim) {
  68         case 1:
  69                 snprintf(port, PORTNAME_MAXLEN-1,
  70                         "%s_%i", base, index0);
  71                 port[PORTNAME_MAXLEN-1] = '\0';
  72                 break;
  73         case 2:
  74                 snprintf(port, PORTNAME_MAXLEN-1,
  75                         "%s_%i_%i", base, index0, index1);
  76                 port[PORTNAME_MAXLEN-1] = '\0';
  77                 break;
  78         case 3:
  79                 snprintf(port, PORTNAME_MAXLEN-1,
  80                         "%s_%i_%i_%i", base, index0, index1, index2),
  81                 port[PORTNAME_MAXLEN-1] = '\0';
  82                 break;
  83         case 4:
  84                 snprintf(port, PORTNAME_MAXLEN-1,
  85                         "%s_%i_%i_%i_%i", base, index0, index1, index2, index3);
  86                 port[PORTNAME_MAXLEN-1] = '\0';
  87                 break;
  88         default:
  89                 while(1);
  90         }
  91
  92         return(port);
  93 }
  94