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>
36 #define PRINTF(fmt,args...) printf (fmt ,##args)
38 #define PRINTF(fmt,args...)
44 #define RELOC_16(seg, off) *(u32*)(seg << 4 | (u32)&off)
45 extern u32 num_pci_bios_present;
46 extern u32 num_pci_bios_find_device;
47 extern u32 num_pci_bios_find_class;
48 extern u32 num_pci_bios_generate_special_cycle;
49 extern u32 num_pci_bios_read_cfg_byte;
50 extern u32 num_pci_bios_read_cfg_word;
51 extern u32 num_pci_bios_read_cfg_dword;
52 extern u32 num_pci_bios_write_cfg_byte;
53 extern u32 num_pci_bios_write_cfg_word;
54 extern u32 num_pci_bios_write_cfg_dword;
55 extern u32 num_pci_bios_get_irq_routing;
56 extern u32 num_pci_bios_set_irq;
57 extern u32 num_pci_bios_unknown_function;
59 void print_bios_bios_stat(void)
61 printf("16 bit functions:\n");
62 printf("pci_bios_present: %d\n", RELOC_16(0xf000, num_pci_bios_present));
63 printf("pci_bios_find_device: %d\n", RELOC_16(0xf000, num_pci_bios_find_device));
64 printf("pci_bios_find_class: %d\n", RELOC_16(0xf000, num_pci_bios_find_class));
65 printf("pci_bios_generate_special_cycle: %d\n", RELOC_16(0xf000, num_pci_bios_generate_special_cycle));
66 printf("pci_bios_read_cfg_byte: %d\n", RELOC_16(0xf000, num_pci_bios_read_cfg_byte));
67 printf("pci_bios_read_cfg_word: %d\n", RELOC_16(0xf000, num_pci_bios_read_cfg_word));
68 printf("pci_bios_read_cfg_dword: %d\n", RELOC_16(0xf000, num_pci_bios_read_cfg_dword));
69 printf("pci_bios_write_cfg_byte: %d\n", RELOC_16(0xf000, num_pci_bios_write_cfg_byte));
70 printf("pci_bios_write_cfg_word: %d\n", RELOC_16(0xf000, num_pci_bios_write_cfg_word));
71 printf("pci_bios_write_cfg_dword: %d\n", RELOC_16(0xf000, num_pci_bios_write_cfg_dword));
72 printf("pci_bios_get_irq_routing: %d\n", RELOC_16(0xf000, num_pci_bios_get_irq_routing));
73 printf("pci_bios_set_irq: %d\n", RELOC_16(0xf000, num_pci_bios_set_irq));
74 printf("pci_bios_unknown_function: %d\n", RELOC_16(0xf000, num_pci_bios_unknown_function));
79 #define PCI_CLASS_VIDEO 3
80 #define PCI_CLASS_VIDEO_STD 0
81 #define PCI_CLASS_VIDEO_PROG_IF_VGA 0
84 static u32 probe_pci_video(void)
88 if ((devbusfn = pci_find_class(PCI_CLASS_VIDEO,
90 PCI_CLASS_VIDEO_PROG_IF_VGA, 0)) != -1) {
94 /* PCI video device detected */
95 printf("Found PCI VGA device at %02x.%02x.%x\n",
96 PCI_BUS(devbusfn), PCI_DEV(devbusfn), PCI_FUNC(devbusfn));
98 /* Enable I/O decoding as well, PCI viudeo boards
99 * support I/O accesses, but they provide no
100 * bar register for this since the ports are fixed.
102 pci_write_config_word(devbusfn, PCI_COMMAND, PCI_COMMAND_MEMORY | PCI_COMMAND_IO | PCI_COMMAND_MASTER);
104 /* Test the ROM decoder, do the device support a rom? */
105 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &old);
106 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, PCI_ROM_ADDRESS_MASK);
107 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &addr);
108 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, old);
111 printf("PCI VGA have no ROM?\n");
115 /* device have a rom */
116 if (pci_shadow_rom(devbusfn, (void*)0xc0000)) {
117 printf("Shadowing of PCI VGA BIOS failed\n");
121 /* Now enable lagacy VGA port access */
122 if (pci_enable_legacy_video_ports(pci_bus_to_hose(PCI_BUS(devbusfn)))) {
123 printf("PCI VGA enable failed\n");
128 /* return the pci device info, that we'll need later */
129 return PCI_BUS(devbusfn) << 8 |
130 PCI_DEV(devbusfn) << 3 | (PCI_FUNC(devbusfn)&7);
139 static int probe_isa_video(void)
144 if (0 == (ptr = isa_map_rom(0xc0000, 0x8000))) {
147 if (NULL == (buf=malloc(0x8000))) {
151 if (readw(ptr) != 0xaa55) {
158 memcpy(buf, (void*)ptr, 0x8000);
160 memcpy((void*)0xc0000, buf, 0x8000);
167 int video_bios_init(void)
171 /* clear the video bios area in case we warmbooted */
172 memset((void*)0xc0000, 0, 0x8000);
173 memset(®s, 0, sizeof(struct pt_regs));
175 if (probe_isa_video()) {
176 /* No ISA board found, try the PCI bus */
177 regs.eax = probe_pci_video();
180 /* Did we succeed in mapping any video bios */
181 if (readw(0xc0000) == 0xaa55) {
186 PRINTF("Found video bios signature\n");
187 size = 512*readb(0xc0002);
188 PRINTF("size %d\n", size);
190 for (i=0;i<size;i++) {
191 sum += readb(0xc0000 + i);
193 PRINTF("Checksum is %sOK\n",sum?"NOT ":"");
198 /* some video bioses (ATI Mach64) seem to think that
199 * the original int 10 handler is always at
200 * 0xf000:0xf065 , place an iret instruction there
202 writeb(0xcf, 0xff065);
206 enter_realmode(0xc000, 3, ®s, ®s);
207 PRINTF("INT 0x10 vector after: %04x:%04x\n",
208 readw(0x42), readw(0x40));
209 PRINTF("BIOS returned %scarry\n", regs.eflags & 1?"":"NOT ");
210 #ifdef PCI_BIOS_DEBUG
211 print_bios_bios_stat();
213 return (regs.eflags & 1);