com32/lib/sys/xserial_write.c

   1 /* ----------------------------------------------------------------------- *
   2  *
   3  *   Copyright 2004-2006 H. Peter Anvin - All Rights Reserved
   4  *
   5  *   Permission is hereby granted, free of charge, to any person
   6  *   obtaining a copy of this software and associated documentation
   7  *   files (the "Software"), to deal in the Software without
   8  *   restriction, including without limitation the rights to use,
   9  *   copy, modify, merge, publish, distribute, sublicense, and/or
  10  *   sell copies of the Software, and to permit persons to whom
  11  *   the Software is furnished to do so, subject to the following
  12  *   conditions:
  13  *
  14  *   The above copyright notice and this permission notice shall
  15  *   be included in all copies or substantial portions of the Software.
  16  *
  17  *   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  18  *   EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
  19  *   OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  20  *   NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
  21  *   HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  22  *   WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  23  *   FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  24  *   OTHER DEALINGS IN THE SOFTWARE.
  25  *
  26  * ----------------------------------------------------------------------- */
  27
  28 /*
  29  * xserial_write.c
  30  *
  31  * Raw writing to the serial port; no \n -> \r\n translation, but
  32  * convert \1# sequences.
  33  */
  34
  35 #include <errno.h>
  36 #include <string.h>
  37 #include <com32.h>
  38 #include <minmax.h>
  39 #include <colortbl.h>
  40 #include "file.h"
  41
  42 static void emit(char ch)
  43 {
  44   static com32sys_t ireg;       /* Zeroed with the BSS */
  45
  46   ireg.eax.b[1] = 0x04;
  47   ireg.edx.b[0] = ch;
  48
  49   __intcall(0x21, &ireg, NULL);
  50 }
  51
  52 ssize_t __xserial_write(struct file_info *fp, const void *buf, size_t count)
  53 {
  54   const char *bufp = buf;
  55   size_t n = 0;
  56   static enum { st_0, st_1, st_2, st_3 } state = st_0;
  57   static int ncolor = 0;
  58   int num;
  59   const char *p;
  60
  61   (void)fp;
  62
  63   while ( count-- ) {
  64     unsigned char ch = *bufp++;
  65
  66     switch (state) {
  67     case st_0:
  68       if (ch == '\1') {
  69         state = st_1;
  70       } else {
  71         emit(ch);
  72       }
  73       break;
  74
  75     case st_1:
  76       if (ch == '#') {
  77         state = st_2;
  78         ncolor = 0;
  79       } else {
  80         state = st_0;
  81       }
  82       break;
  83
  84     case st_2:
  85       num = ch-'0';
  86       if (num < 10) {
  87         ncolor = num*10;
  88         state = st_3;
  89       } else {
  90         state = st_0;
  91       }
  92       break;
  93
  94     case st_3:
  95       num = ch-'0';
  96       if (num < 10) {
  97         ncolor += num;
  98
  99         if (ncolor < console_color_table_size) {
 100           emit('\033');
 101           emit('[');
 102           emit('0');
 103           emit(';');
 104           for (p = console_color_table[ncolor].ansi; *p; p++)
 105             emit(*p);
 106           emit('m');
 107         }
 108       }
 109       state = st_0;
 110       break;
 111     }
 112
 113     n++;
 114   }
 115
 116   return n;
 117 }