3 * Daniel Engström, Omicron Ceti AB, <daniel@omicron.se>
5 * See file CREDITS for list of people who contributed to this
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 of
11 * the License, or (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
27 #include <asm/ptrace.h>
28 #include <asm/realmode.h>
37 #define PRINTF(fmt, args...) printf(fmt, ##args)
39 #define PRINTF(fmt, args...)
45 void print_bios_bios_stat(void)
47 printf("16 bit functions:\n");
48 printf("pci_bios_present: %d\n",
49 RELOC_16_LONG(0xf000, num_pci_bios_present));
50 printf("pci_bios_find_device: %d\n",
51 RELOC_16_LONG(0xf000, num_pci_bios_find_device));
52 printf("pci_bios_find_class: %d\n",
53 RELOC_16_LONG(0xf000, num_pci_bios_find_class));
54 printf("pci_bios_generate_special_cycle: %d\n",
56 num_pci_bios_generate_special_cycle));
57 printf("pci_bios_read_cfg_byte: %d\n",
58 RELOC_16_LONG(0xf000, num_pci_bios_read_cfg_byte));
59 printf("pci_bios_read_cfg_word: %d\n",
60 RELOC_16_LONG(0xf000, num_pci_bios_read_cfg_word));
61 printf("pci_bios_read_cfg_dword: %d\n",
62 RELOC_16_LONG(0xf000, num_pci_bios_read_cfg_dword));
63 printf("pci_bios_write_cfg_byte: %d\n",
64 RELOC_16_LONG(0xf000, num_pci_bios_write_cfg_byte));
65 printf("pci_bios_write_cfg_word: %d\n",
66 RELOC_16_LONG(0xf000, num_pci_bios_write_cfg_word));
67 printf("pci_bios_write_cfg_dword: %d\n",
68 RELOC_16_LONG(0xf000, num_pci_bios_write_cfg_dword));
69 printf("pci_bios_get_irq_routing: %d\n",
70 RELOC_16_LONG(0xf000, num_pci_bios_get_irq_routing));
71 printf("pci_bios_set_irq: %d\n",
72 RELOC_16_LONG(0xf000, num_pci_bios_set_irq));
73 printf("pci_bios_unknown_function: %d\n",
74 RELOC_16_LONG(0xf000, num_pci_bios_unknown_function));
81 #define PCI_CLASS_VIDEO 3
82 #define PCI_CLASS_VIDEO_STD 0
83 #define PCI_CLASS_VIDEO_PROG_IF_VGA 0
85 DEFINE_PCI_DEVICE_TABLE(supported) = {
86 {PCI_VIDEO_VENDOR_ID, PCI_VIDEO_DEVICE_ID},
90 static u32 probe_pci_video(void)
92 struct pci_controller *hose;
93 pci_dev_t devbusfn = pci_find_devices(supported, 0);
95 if ((devbusfn != -1)) {
99 /* PCI video device detected */
100 printf("Found PCI VGA device at %02x.%02x.%x\n",
105 /* Enable I/O decoding as well, PCI viudeo boards
106 * support I/O accesses, but they provide no
107 * bar register for this since the ports are fixed.
109 pci_write_config_word(devbusfn,
115 /* Test the ROM decoder, do the device support a rom? */
116 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &old);
117 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS,
118 (u32)PCI_ROM_ADDRESS_MASK);
119 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &addr);
120 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, old);
123 printf("PCI VGA have no ROM?\n");
127 /* device have a rom */
128 if (pci_shadow_rom(devbusfn, (void *)0xc0000)) {
129 printf("Shadowing of PCI VGA BIOS failed\n");
133 /* Now enable lagacy VGA port access */
134 hose = pci_bus_to_hose(PCI_BUS(devbusfn));
135 if (pci_enable_legacy_video_ports(hose)) {
136 printf("PCI VGA enable failed\n");
141 /* return the pci device info, that we'll need later */
142 return PCI_BUS(devbusfn) << 8 |
143 PCI_DEV(devbusfn) << 3 | (PCI_FUNC(devbusfn) & 7);
149 static int probe_isa_video(void)
154 ptr = isa_map_rom(0xc0000, 0x8000);
159 buf = malloc(0x8000);
165 if (readw(ptr) != 0xaa55) {
172 memcpy(buf, (void *)ptr, 0x8000);
174 memcpy((void *)0xc0000, buf, 0x8000);
181 int video_bios_init(void)
188 /* clear the video bios area in case we warmbooted */
189 memset((void *)0xc0000, 0, 0x8000);
190 memset(®s, 0, sizeof(struct pt_regs));
192 if (probe_isa_video())
193 /* No ISA board found, try the PCI bus */
194 regs.eax = probe_pci_video();
196 /* Did we succeed in mapping any video bios */
197 if (readw(0xc0000) == 0xaa55) {
198 PRINTF("Found video bios signature\n");
199 size = readb(0xc0002) * 512;
200 PRINTF("size %d\n", size);
203 for (i = 0; i < size; i++)
204 sum += readb(0xc0000 + i);
206 PRINTF("Checksum is %sOK\n", sum ? "NOT " : "");
212 * Some video bioses (ATI Mach64) seem to think that
213 * the original int 10 handler is always at
214 * 0xf000:0xf065 , place an iret instruction there
216 writeb(0xcf, 0xff065);
220 enter_realmode(0xc000, 3, ®s, ®s);
222 PRINTF("INT 0x10 vector after: %04x:%04x\n",
223 readw(0x42), readw(0x40));
224 PRINTF("BIOS returned %scarry\n",
225 regs.eflags & 0x00000001 ? "" : "NOT ");
226 #ifdef PCI_BIOS_DEBUG
227 print_bios_bios_stat();
229 return regs.eflags & 0x00000001;