Add support for Intel Sandybridge CPU (northbridge part)

[coreboot.git] / src / northbridge / intel / i82830 / vga.c

diff --git a/src/northbridge/intel/i82830/vga.c b/src/northbridge/intel/i82830/vga.c
index e9cfdac0c65332ed3b9c54cfef4ced8b4ab49503..c82c484a3a5239528db53061a5483c948fb2fa0f 100644 (file)
--- a/src/northbridge/intel/i82830/vga.c
+++ b/src/northbridge/intel/i82830/vga.c
@@ -24,13 +24,69 @@
 #include <device/device.h>
 #include <device/pci.h>
 #include <device/pci_ids.h>
+#include <cbfs.h>
+#if CONFIG_PCI_OPTION_ROM_RUN_YABEL
+#include <x86emu/x86emu.h>
+#endif
 
-static void vga_init(device_t dev) {
+static void vga_init(device_t dev)
+{
+       printk(BIOS_INFO, "Starting Graphics Initialization\n");
+       struct cbfs_file *file = cbfs_find("mbi.bin");
+       void *mbi = NULL;
+       unsigned int mbi_len = 0;
+
+       if (file) {
+               if (ntohl(file->type) != CBFS_TYPE_MBI) {
+                       printk(BIOS_INFO,  "CBFS:  MBI binary is of type %x instead of"
+                              "type %x\n", file->type, CBFS_TYPE_MBI);
+               } else {
+                       mbi = (void *) CBFS_SUBHEADER(file);
+                       mbi_len = ntohl(file->len);
+               }
+       } else {
+               printk(BIOS_INFO,  "Could not find MBI.\n");
+       }
+
+       if (mbi && mbi_len) {
+               /* The GDT or coreboot table is going to live here. But
+                * a long time after we relocated the GNVS, so this is
+                * not troublesome.
+                */
+               *(u32 *)0x500 = (u32)mbi;
+               *(u32 *)0x504 = (u32)mbi_len;
+               outb(0xeb, 0xb2);
+       }
 
-       printk_info("Starting Graphics Initialization\n");
        pci_dev_init(dev);
-       printk_info("Graphics Initialization Complete\n");
-       /* Future TV-OUT code will be called from here. */
+       printk(BIOS_INFO, "Graphics Initialization Complete\n");
+
+       /* Enable TV-Out */
+#if CONFIG_PCI_OPTION_ROM_RUN_YABEL
+#define PIPE_A_CRT     (1 << 0)
+#define PIPE_A_LFP     (1 << 1)
+#define PIPE_A_TV      (1 << 3)
+#define PIPE_B_CRT     (1 << 8)
+#define PIPE_B_TV      (1 << 10)
+       printk(BIOS_DEBUG, "Enabling TV-Out\n");
+       void runInt10(void);
+       M.x86.R_AX = 0x5f64;
+       M.x86.R_BX = 0x0001; // Set Display Device, force execution
+       M.x86.R_CX = PIPE_A_CRT | PIPE_A_TV;
+       // M.x86.R_CX = PIPE_B_TV;
+       runInt10();
+       switch (M.x86.R_AX) {
+       case 0x005f:
+               printk(BIOS_DEBUG, "... failed.\n");
+               break;
+       case 0x015f:
+               printk(BIOS_DEBUG, "... ok.\n");
+               break;
+       default:
+               printk(BIOS_DEBUG, "... not supported.\n");
+               break;
+       }
+#endif
 }
 
 static const struct device_operations vga_operations = {