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
emit(char ch)44 static void emit(char ch)
45 {
46 write_serial(ch);
47 }
48
__xserial_write(struct file_info * fp,const void * buf,size_t count)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