com32/lib/sys/xserial_write.c

   1 /* ----------------------------------------------------------------------- *
   2  *
   3  *   Copyright 2004-2008 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; \n -> \r\n translation, and
  32  * convert \1# sequences.
  33  */
  34
  35 #include <errno.h>
  36 #include <string.h>
  37 #include <com32.h>
  38 #include <core.h>
  39 #include <minmax.h>
  40 #include <colortbl.h>
  41 #include <syslinux/config.h>
  42 #include "file.h"
  43
  44 static void emit(char ch)
  45 {
  46     write_serial(ch);
  47 }
  48
  49 ssize_t __xserial_write(struct file_info *fp, const void *buf, size_t count)
  50 {
  51     const char *bufp = buf;
  52     size_t n = 0;
  53     static enum { st_init, st_tbl, st_tblc } state = st_init;
  54     static int ndigits;
  55     static int ncolor = 0;
  56     int num;
  57     const char *p;
  58
  59     (void)fp;
  60
  61     if (!syslinux_serial_console_info()->iobase)
  62         return count;           /* Nothing to do */
  63
  64     while (count--) {
  65         unsigned char ch = *bufp++;
  66
  67         switch (state) {
  68         case st_init:
  69             if (ch >= 1 && ch <= 5) {
  70                 state = st_tbl;
  71                 ndigits = ch;
  72             } else if (ch == '\n') {
  73                 emit('\r');
  74                 emit('\n');
  75             } else {
  76                 emit(ch);
  77             }
  78             break;
  79
  80         case st_tbl:
  81             if (ch == '#') {
  82                 state = st_tblc;
  83                 ncolor = 0;
  84             } else {
  85                 state = st_init;
  86             }
  87             break;
  88
  89         case st_tblc:
  90             num = ch - '0';
  91             if (num < 10) {
  92                 ncolor = (ncolor * 10) + num;
  93                 if (--ndigits == 0) {
  94                     if (ncolor < console_color_table_size) {
  95                         emit('\033');
  96                         emit('[');
  97                         emit('0');
  98                         emit(';');
  99                         for (p = console_color_table[ncolor].ansi; *p; p++)
 100                             emit(*p);
 101                         emit('m');
 102                     }
 103                     state = st_init;
 104                 }
 105             } else {
 106                 state = st_init;
 107             }
 108             break;
 109         }
 110         n++;
 111     }
 112
 113     return n;
 114 }