Home | History | Annotate | Download | only in sys 
      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 }
    115