com32/libutil/ansiraw.c

   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