From patchwork Tue Sep  7 23:38:10 2010
Content-Type: text/plain; charset="utf-8"
MIME-Version: 1.0
Content-Transfer-Encoding: 7bit
Subject: basic realmode handlers for int 0x10 and int 0x16
Date: Tue, 07 Sep 2010 23:38:10 -0000
From: Myles Watson <mylesgw@gmail.com>
X-Patchwork-Id: 1886
Message-Id: <AANLkTi=OoOmqV1yyOXtcu0Y0Hk_yt=+h4JO9d-9kUfe9@mail.gmail.com>
To: coreboot <coreboot@coreboot.org>

My Jmicron SATA card writes the name of the hard drive to the screen.
This redirects that output to the console and implements a basic
keyboard stub.

Signed-off-by: Myles Watson <mylesgw@gmail.com>

It makes the image a little bit larger (512 bytes after compression),
so I'm wondering if I should wrap it in a Kconfig option.  It doesn't
seem worth the mess in the code for such a little bit of space.

Thanks,
Myles
Acked-by: Patrick Georgi <patrick.georgi@coresystems.de>


Index: svn/src/devices/oprom/x86.c
===================================================================
--- svn.orig/src/devices/oprom/x86.c
+++ svn/src/devices/oprom/x86.c
@@ -92,8 +92,8 @@ static int intXX_exception_handler(struc
 
 static int intXX_unknown_handler(struct eregs *regs)
 {
-	printk(BIOS_INFO, "Unsupported software interrupt #0x%x\n",
-			regs->vector);
+	printk(BIOS_INFO, "Unsupported software interrupt #0x%x eax 0x%x\n",
+			regs->vector, regs->eax);
 
 	return -1;
 }
@@ -104,6 +104,75 @@ void mainboard_interrupt_handlers(int in
 	intXX_handler[intXX] = intXX_func;
 }
 
+static int int10_handler(struct eregs *regs)
+{
+	int res=-1;
+	static u8 cursor_row=0, cursor_col=0;
+	switch((regs->eax & 0xff00)>>8) {
+	case 0x01: // Set cursor shape
+		res = 0;
+		break;
+	case 0x02: // Set cursor position
+		if (cursor_row != ((regs->edx >> 8) & 0xff) ||
+		    cursor_col >= (regs->edx & 0xff)) {
+			printk(BIOS_INFO, "\n");
+		}
+		cursor_row = (regs->edx >> 8) & 0xff;
+		cursor_col = regs->edx & 0xff;
+		res = 0;
+		break;
+	case 0x03: // Get cursor position
+		regs->eax &= 0x00ff;
+		regs->ecx = 0x0607;
+		regs->edx = (cursor_row << 8) | cursor_col;
+		res = 0;
+		break;
+	case 0x06: // Scroll up
+		printk(BIOS_INFO, "\n");
+		res = 0;
+		break;
+	case 0x08: // Get Character and Mode at Cursor Position
+		regs->eax = 0x0f00 | 'A'; // White on black 'A'
+		res = 0;
+		break;
+	case 0x09: // Write Character and attribute
+	case 0x10: // Write Character
+		printk(BIOS_INFO, "%c", regs->eax & 0xff);
+		res = 0;
+		break;
+	case 0x0f: // Get video mode
+		regs->eax = 0x5002; //80x25
+		regs->ebx &= 0x00ff;
+		res = 0;
+		break;
+        default:
+		printk(BIOS_WARNING, "Unknown INT10 function %04x!\n",
+				regs->eax & 0xffff);
+		break;
+	}
+	return res;
+}
+
+static int int16_handler(struct eregs *regs)
+{
+	int res=-1;
+	switch((regs->eax & 0xff00)>>8) {
+	case 0x00: // Check for Keystroke
+		regs->eax = 0x1c10; // Enter Key, Line feed
+		res = 0;
+		break;
+	case 0x01: // Check for Keystroke
+		regs->eflags |= 1<<6; // Zero Flag set (no key available)
+		res = 0;
+		break;
+        default:
+		printk(BIOS_WARNING, "Unknown INT16 function %04x!\n",
+				regs->eax & 0xffff);
+		break;
+	}
+	return res;
+}
+
 int int12_handler(struct eregs *regs);
 int int15_handler(struct eregs *regs);
 int int1a_handler(struct eregs *regs);
@@ -131,12 +200,18 @@ static void setup_interrupt_handlers(voi
 			 * interrupt handlers, such as the int15
 			 */
 			switch (i) {
+			case 0x10:
+				intXX_handler[0x10] = &int10_handler;
+				break;
 			case 0x12:
 				intXX_handler[0x12] = &int12_handler;
 				break;
 			case 0x15:
 				intXX_handler[0x15] = &int15_handler;
 				break;
+			case 0x16:
+				intXX_handler[0x16] = &int16_handler;
+				break;
 			case 0x1a:
 				intXX_handler[0x1a] = &int1a_handler;
 				break;