Home | History | Annotate | Download | only in libutil 
      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  * ansiraw.c
     30  *
     31  * Configures the console for ANSI output in raw mode; versions
     32  * for COM32 and Linux support.
     33  */
     34 
     35 #ifdef __COM32__
     36 
     37 #include <stdio.h>
     38 #include <unistd.h>
     39 #include <console.h>
     40 
     41 void console_ansi_raw(void)
     42 {
     43     openconsole(&dev_rawcon_r, &dev_ansiserial_w);
     44 }
     45 
     46 #else
     47 
     48 #include <stdio.h>
     49 #include <termios.h>
     50 #include <unistd.h>
     51 
     52 static struct termios original_termios_settings;
     53 
     54 static void __attribute__ ((constructor)) console_init(void)
     55 {
     56     tcgetattr(0, &original_termios_settings);
     57 }
     58 
     59 static void __attribute__ ((destructor)) console_cleanup(void)
     60 {
     61     tcsetattr(0, TCSANOW, &original_termios_settings);
     62 }
     63 
     64 void console_ansi_raw(void)
     65 {
     66     struct termios tio;
     67 
     68     /* Disable stdio buffering */
     69     setbuf(stdin, NULL);
     70     setbuf(stdout, NULL);
     71     setbuf(stderr, NULL);
     72 
     73     /* Set the termios flag so we behave the same as libcom32 */
     74     tcgetattr(0, &tio);
     75     tio.c_iflag &= ~ICRNL;
     76     tio.c_iflag |= IGNCR;
     77     tio.c_lflag &= ~(ISIG | ICANON | ECHO);
     78     if (!tio.c_oflag & OPOST)
     79 	tio.c_oflag = 0;
     80     tio.c_oflag |= OPOST | ONLCR;
     81     tio.c_cc[VMIN] = 0;
     82     tio.c_cc[VTIME] = 1;	/* Don't 100% busy-wait in Linux */
     83     tcsetattr(0, TCSAFLUSH, &tio);
     84 }
     85 
     86 int raw_read(int fd, void *buf, size_t count)
     87 {
     88 	struct termios tio, rtio;
     89 	int rv;
     90 
     91 	tcgetattr(fd, &tio);
     92 
     93 	cfmakeraw(&rtio);
     94 	tcsetattr(fd, 0, &rtio);
     95 
     96 	rv = read(fd, buf, count);
     97 
     98 	/* Restore settings */
     99 	tcsetattr(fd, 0, &tio);
    100 
    101 	return rv;
    102 }
    103 
    104 #endif
    105