workbench/devs/serial/serial_support.c

   1 /*
   2     Copyright © 1995-2001, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6
   7 #include <proto/exec.h>
   8 #include <exec/tasks.h>
   9 #include <exec/lists.h>
  10 #include <exec/memory.h>
  11
  12 #include "serial_intern.h"
  13
  14 #define DEBUG 0
  15 #include <aros/debug.h>
  16
  17 /**************************************************************************
  18   Copy data from the buffer where it is collected to the destination buffer
  19   in the IORequest structure
  20   The return value indicates whether the request could be satisfied
  21   completely or not.
  22 **************************************************************************/
  23
  24 BOOL copyInData(struct SerialUnit * SU, struct IOStdReq * ioreq)
  25 {
  26   UWORD count = 0;
  27   UWORD index = SU->su_InputFirst;
  28   UBYTE * Buffer = ioreq->io_Data;
  29
  30   D(bug("su_InputNextPos: %d  su_InputFirst: %d\n",SU->su_InputNextPos, index));
  31
  32   while (count < ioreq->io_Length &&
  33          SU->su_InputNextPos != index)
  34   {
  35     /* copy one byte */
  36     Buffer[count] = SU->su_InputBuffer[index];
  37
  38     count++;
  39     index++;
  40     /*
  41     **  The buffer is organized in a circular fashion with
  42     **  length SU->su_InBufLength
  43      */
  44     if (index == SU->su_InBufLength)
  45       index = 0;
  46   }
  47   /* move the index of the first valid byte for the next read */
  48   SU->su_InputFirst = index;
  49   ioreq->io_Actual = count;
  50
  51   SU->su_Status &= ~STATUS_BUFFEROVERFLOW;
  52
  53   if (count == ioreq->io_Length)
  54     return TRUE;
  55
  56   /* The request could not be satisfied completely */
  57   return FALSE;
  58 }
  59
  60 /**************************************************************************
  61   Copy data from the buffer where it is collected to the destination buffer
  62   in the IORequest structure
  63   The return value indicates whether the request could be satisfied
  64   completely or not.
  65 **************************************************************************/
  66
  67 BOOL copyInDataUntilZero(struct SerialUnit * SU, struct IOStdReq * ioreq)
  68 {
  69   UWORD count = 0;
  70   UWORD index = SU->su_InputFirst;
  71   BYTE * Buffer = ioreq->io_Data;
  72   BOOL end = FALSE;
  73
  74   while (SU->su_InputNextPos != index)
  75   {
  76     /* copy one byte */
  77     Buffer[count] = SU->su_InputBuffer[index];
  78
  79     /* was that the terminating zero? */
  80     if (0 == Buffer[count])
  81     {
  82       end = TRUE;
  83       break;
  84     }
  85
  86     count++;
  87     index++;
  88     /*
  89     **  The buffer is organized in a circular fashion with
  90     **  length SU->su_InBufLength
  91      */
  92     if (index == SU->su_InBufLength)
  93       index = 0;
  94   }
  95   /* move the index of the first valid byte for the next read */
  96   SU->su_InputFirst = index;
  97
  98   SU->su_Status &= ~STATUS_BUFFEROVERFLOW;
  99
 100   /* whatever is in end represents "satisfied request"(TRUE) or
 101      "unsatisfied request" (FALSE) */
 102
 103   if (TRUE == end)
 104   {
 105     ioreq->io_Actual = count;
 106     return TRUE;
 107   }
 108
 109   /* make io_Actual point to the next index in the buffer */
 110   ioreq->io_Actual = count+1;
 111   return FALSE;
 112 }
 113
 114
 115 struct SerialUnit * findUnit(struct serialbase * SerialDevice,
 116                              ULONG unitnum)
 117 {
 118   struct SerialUnit * su;
 119   ForeachNode(&SerialDevice->UnitList, su)
 120   {
 121     if (su->su_UnitNum == unitnum)
 122       return su;
 123   }
 124   return NULL;
 125 }
 126