Add qemu 2.4.0

[kvmfornfv.git] / qemu / roms / ipxe / src / interface / linux / linux_console.c

diff --git a/qemu/roms/ipxe/src/interface/linux/linux_console.c b/qemu/roms/ipxe/src/interface/linux/linux_console.c
new file mode 100644 (file)
index 0000000..5105eaa
--- /dev/null
+++ b/qemu/roms/ipxe/src/interface/linux/linux_console.c
@@ -0,0 +1,155 @@
+/*
+ * Copyright (C) 2010 Piotr Jaroszyński <p.jaroszynski@gmail.com>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of the
+ * License, or any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA.
+ */
+
+FILE_LICENCE(GPL2_OR_LATER);
+
+/** @file
+ *
+ * Linux console implementation.
+ *
+ */
+
+#include <ipxe/console.h>
+
+#include <ipxe/init.h>
+#include <ipxe/keys.h>
+#include <linux_api.h>
+
+#include <linux/termios.h>
+#include <asm/errno.h>
+
+#include <config/console.h>
+
+/* Set default console usage if applicable */
+#if ! ( defined ( CONSOLE_LINUX ) && CONSOLE_EXPLICIT ( CONSOLE_LINUX ) )
+#undef CONSOLE_LINUX
+#define CONSOLE_LINUX ( CONSOLE_USAGE_ALL & ~CONSOLE_USAGE_LOG )
+#endif
+
+static void linux_console_putchar(int c)
+{
+       /* write to stdout */
+       if (linux_write(1, &c, 1) != 1)
+               DBG("linux_console write failed (%s)\n", linux_strerror(linux_errno));
+}
+
+static int linux_console_getchar()
+{
+       char c;
+
+       /* read from stdin */
+       if (linux_read(0, &c, 1) < 0) {
+               DBG("linux_console read failed (%s)\n", linux_strerror(linux_errno));
+               return 0;
+       }
+       /* backspace seems to be returned as ascii del, map it here */
+       if (c == 0x7f)
+               return KEY_BACKSPACE;
+       else
+               return c;
+}
+
+static int linux_console_iskey()
+{
+       struct pollfd pfd;
+       pfd.fd = 0;
+       pfd.events = POLLIN;
+
+       /* poll for data to be read on stdin */
+       if (linux_poll(&pfd, 1, 0) == -1) {
+               DBG("linux_console poll failed (%s)\n", linux_strerror(linux_errno));
+               return 0;
+       }
+
+       if (pfd.revents & POLLIN)
+               return 1;
+       else
+               return 0;
+}
+
+struct console_driver linux_console __console_driver = {
+       .disabled = 0,
+       .putchar = linux_console_putchar,
+       .getchar = linux_console_getchar,
+       .iskey = linux_console_iskey,
+       .usage = CONSOLE_LINUX,
+};
+
+static int linux_tcgetattr(int fd, struct termios *termios_p)
+{
+       return linux_ioctl(fd, TCGETS, termios_p);
+}
+
+static int linux_tcsetattr(int fd, int optional_actions, const struct termios *termios_p)
+{
+       unsigned long int cmd;
+
+       switch (optional_actions)
+       {
+               case TCSANOW:
+                       cmd = TCSETS;
+                       break;
+               case TCSADRAIN:
+                       cmd = TCSETSW;
+                       break;
+               case TCSAFLUSH:
+                       cmd = TCSETSF;
+                       break;
+               default:
+                       linux_errno = EINVAL;
+                       return -1;
+       }
+
+       return linux_ioctl(fd, cmd, termios_p);
+}
+
+/** Saved termios attributes */
+static struct termios saved_termios;
+
+/** Setup the terminal for our use */
+static void linux_console_startup(void)
+{
+       struct termios t;
+
+       if (linux_tcgetattr(0, &t)) {
+               DBG("linux_console tcgetattr failed (%s)", linux_strerror(linux_errno));
+               return;
+       }
+
+       saved_termios = t;
+
+       /* Disable canonical mode and echo. Let readline handle that */
+       t.c_lflag &= ~(ECHO | ICANON);
+       /* stop ^C from sending a signal */
+       t.c_cc[VINTR] = 0;
+
+       if (linux_tcsetattr(0, TCSAFLUSH, &t))
+               DBG("linux_console tcsetattr failed (%s)", linux_strerror(linux_errno));
+}
+
+/** Restores original terminal attributes on shutdown */
+static void linux_console_shutdown(int flags __unused)
+{
+       if (linux_tcsetattr(0, TCSAFLUSH, &saved_termios))
+               DBG("linux_console tcsetattr failed (%s)", linux_strerror(linux_errno));
+}
+
+struct startup_fn linux_console_startup_fn __startup_fn(STARTUP_EARLY) = {
+       .startup = linux_console_startup,
+       .shutdown = linux_console_shutdown,
+};