syslinux-3.08-2 sources from FC4
[bootcd.git] / syslinux / com32 / lib / sys / stdcon_write.c
1 #ident "$Id: stdcon_write.c,v 1.3 2004/11/23 23:43:02 hpa Exp $"
2 /* ----------------------------------------------------------------------- *
3  *   
4  *   Copyright 2004 H. Peter Anvin - All Rights Reserved
5  *
6  *   Permission is hereby granted, free of charge, to any person
7  *   obtaining a copy of this software and associated documentation
8  *   files (the "Software"), to deal in the Software without
9  *   restriction, including without limitation the rights to use,
10  *   copy, modify, merge, publish, distribute, sublicense, and/or
11  *   sell copies of the Software, and to permit persons to whom
12  *   the Software is furnished to do so, subject to the following
13  *   conditions:
14  *   
15  *   The above copyright notice and this permission notice shall
16  *   be included in all copies or substantial portions of the Software.
17  *   
18  *   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
19  *   EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
20  *   OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
21  *   NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
22  *   HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
23  *   WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
24  *   FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
25  *   OTHER DEALINGS IN THE SOFTWARE.
26  *
27  * ----------------------------------------------------------------------- */
28
29 /*
30  * stdcon_write.c
31  *
32  * Writing to the console
33  */
34
35 #include <errno.h>
36 #include <string.h>
37 #include <com32.h>
38 #include <minmax.h>
39 #include "file.h"
40
41 static ssize_t __stdcon_write(struct file_info *fp, const void *buf, size_t count)
42 {
43   com32sys_t ireg;
44   const char *bufp = buf;
45   size_t n = 0;
46
47   (void)fp;
48
49   memset(&ireg, 0, sizeof ireg); 
50   ireg.eax.b[1] = 0x02;
51
52   while ( count-- ) {
53     if ( *bufp == '\n' ) {
54       ireg.edx.b[0] = '\r';
55       __intcall(0x21, &ireg, NULL);
56     }
57     ireg.edx.b[0] = *bufp++;
58     __intcall(0x21, &ireg, NULL);
59     n++;
60   }
61
62   return n;
63 }
64
65 const struct output_dev dev_stdcon_w = {
66   .dev_magic  = __DEV_MAGIC,
67   .flags      = __DEV_TTY | __DEV_OUTPUT,
68   .fileflags  = O_WRONLY | O_CREAT | O_TRUNC | O_APPEND,
69   .write      = __stdcon_write,
70   .close      = NULL,
71 };