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
44static void emit(char ch)
45{
46    write_serial(ch);
47}
48
49ssize_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