|
@@ -28,86 +28,94 @@
|
|
#include <asm/realmode.h>
|
|
#include <asm/realmode.h>
|
|
#include <asm/io.h>
|
|
#include <asm/io.h>
|
|
#include <asm/pci.h>
|
|
#include <asm/pci.h>
|
|
|
|
+#include "bios.h"
|
|
|
|
|
|
#undef PCI_BIOS_DEBUG
|
|
#undef PCI_BIOS_DEBUG
|
|
#undef VGA_BIOS_DEBUG
|
|
#undef VGA_BIOS_DEBUG
|
|
|
|
|
|
#ifdef VGA_BIOS_DEBUG
|
|
#ifdef VGA_BIOS_DEBUG
|
|
-#define PRINTF(fmt,args...) printf (fmt ,##args)
|
|
|
|
|
|
+#define PRINTF(fmt, args...) printf(fmt, ##args)
|
|
#else
|
|
#else
|
|
-#define PRINTF(fmt,args...)
|
|
|
|
|
|
+#define PRINTF(fmt, args...)
|
|
#endif
|
|
#endif
|
|
|
|
|
|
#ifdef CONFIG_PCI
|
|
#ifdef CONFIG_PCI
|
|
|
|
|
|
#ifdef PCI_BIOS_DEBUG
|
|
#ifdef PCI_BIOS_DEBUG
|
|
-#define RELOC_16(seg, off) *(u32*)(seg << 4 | (u32)&off)
|
|
|
|
-extern u32 num_pci_bios_present;
|
|
|
|
-extern u32 num_pci_bios_find_device;
|
|
|
|
-extern u32 num_pci_bios_find_class;
|
|
|
|
-extern u32 num_pci_bios_generate_special_cycle;
|
|
|
|
-extern u32 num_pci_bios_read_cfg_byte;
|
|
|
|
-extern u32 num_pci_bios_read_cfg_word;
|
|
|
|
-extern u32 num_pci_bios_read_cfg_dword;
|
|
|
|
-extern u32 num_pci_bios_write_cfg_byte;
|
|
|
|
-extern u32 num_pci_bios_write_cfg_word;
|
|
|
|
-extern u32 num_pci_bios_write_cfg_dword;
|
|
|
|
-extern u32 num_pci_bios_get_irq_routing;
|
|
|
|
-extern u32 num_pci_bios_set_irq;
|
|
|
|
-extern u32 num_pci_bios_unknown_function;
|
|
|
|
-
|
|
|
|
void print_bios_bios_stat(void)
|
|
void print_bios_bios_stat(void)
|
|
{
|
|
{
|
|
printf("16 bit functions:\n");
|
|
printf("16 bit functions:\n");
|
|
- printf("pci_bios_present: %d\n", RELOC_16(0xf000, num_pci_bios_present));
|
|
|
|
- printf("pci_bios_find_device: %d\n", RELOC_16(0xf000, num_pci_bios_find_device));
|
|
|
|
- printf("pci_bios_find_class: %d\n", RELOC_16(0xf000, num_pci_bios_find_class));
|
|
|
|
- printf("pci_bios_generate_special_cycle: %d\n", RELOC_16(0xf000, num_pci_bios_generate_special_cycle));
|
|
|
|
- printf("pci_bios_read_cfg_byte: %d\n", RELOC_16(0xf000, num_pci_bios_read_cfg_byte));
|
|
|
|
- printf("pci_bios_read_cfg_word: %d\n", RELOC_16(0xf000, num_pci_bios_read_cfg_word));
|
|
|
|
- printf("pci_bios_read_cfg_dword: %d\n", RELOC_16(0xf000, num_pci_bios_read_cfg_dword));
|
|
|
|
- printf("pci_bios_write_cfg_byte: %d\n", RELOC_16(0xf000, num_pci_bios_write_cfg_byte));
|
|
|
|
- printf("pci_bios_write_cfg_word: %d\n", RELOC_16(0xf000, num_pci_bios_write_cfg_word));
|
|
|
|
- printf("pci_bios_write_cfg_dword: %d\n", RELOC_16(0xf000, num_pci_bios_write_cfg_dword));
|
|
|
|
- printf("pci_bios_get_irq_routing: %d\n", RELOC_16(0xf000, num_pci_bios_get_irq_routing));
|
|
|
|
- printf("pci_bios_set_irq: %d\n", RELOC_16(0xf000, num_pci_bios_set_irq));
|
|
|
|
- printf("pci_bios_unknown_function: %d\n", RELOC_16(0xf000, num_pci_bios_unknown_function));
|
|
|
|
|
|
+ printf("pci_bios_present: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_present));
|
|
|
|
+ printf("pci_bios_find_device: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_find_device));
|
|
|
|
+ printf("pci_bios_find_class: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_find_class));
|
|
|
|
+ printf("pci_bios_generate_special_cycle: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000,
|
|
|
|
+ num_pci_bios_generate_special_cycle));
|
|
|
|
+ printf("pci_bios_read_cfg_byte: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_read_cfg_byte));
|
|
|
|
+ printf("pci_bios_read_cfg_word: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_read_cfg_word));
|
|
|
|
+ printf("pci_bios_read_cfg_dword: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_read_cfg_dword));
|
|
|
|
+ printf("pci_bios_write_cfg_byte: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_write_cfg_byte));
|
|
|
|
+ printf("pci_bios_write_cfg_word: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_write_cfg_word));
|
|
|
|
+ printf("pci_bios_write_cfg_dword: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_write_cfg_dword));
|
|
|
|
+ printf("pci_bios_get_irq_routing: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_get_irq_routing));
|
|
|
|
+ printf("pci_bios_set_irq: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_set_irq));
|
|
|
|
+ printf("pci_bios_unknown_function: %d\n",
|
|
|
|
+ RELOC_16_LONG(0xf000, num_pci_bios_unknown_function));
|
|
|
|
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
|
|
#ifdef CONFIG_VIDEO
|
|
#ifdef CONFIG_VIDEO
|
|
|
|
|
|
-#define PCI_CLASS_VIDEO 3
|
|
|
|
-#define PCI_CLASS_VIDEO_STD 0
|
|
|
|
-#define PCI_CLASS_VIDEO_PROG_IF_VGA 0
|
|
|
|
|
|
+#define PCI_CLASS_VIDEO 3
|
|
|
|
+#define PCI_CLASS_VIDEO_STD 0
|
|
|
|
+#define PCI_CLASS_VIDEO_PROG_IF_VGA 0
|
|
|
|
|
|
-static struct pci_device_id supported[] = {
|
|
|
|
|
|
+DEFINE_PCI_DEVICE_TABLE(supported) = {
|
|
{PCI_VIDEO_VENDOR_ID, PCI_VIDEO_DEVICE_ID},
|
|
{PCI_VIDEO_VENDOR_ID, PCI_VIDEO_DEVICE_ID},
|
|
{}
|
|
{}
|
|
};
|
|
};
|
|
|
|
|
|
static u32 probe_pci_video(void)
|
|
static u32 probe_pci_video(void)
|
|
{
|
|
{
|
|
- pci_dev_t devbusfn;
|
|
|
|
|
|
+ struct pci_controller *hose;
|
|
|
|
+ pci_dev_t devbusfn = pci_find_devices(supported, 0);
|
|
|
|
|
|
- if ((devbusfn = pci_find_devices(supported, 0) != -1)) {
|
|
|
|
|
|
+ if ((devbusfn != -1)) {
|
|
u32 old;
|
|
u32 old;
|
|
u32 addr;
|
|
u32 addr;
|
|
|
|
|
|
/* PCI video device detected */
|
|
/* PCI video device detected */
|
|
printf("Found PCI VGA device at %02x.%02x.%x\n",
|
|
printf("Found PCI VGA device at %02x.%02x.%x\n",
|
|
- PCI_BUS(devbusfn), PCI_DEV(devbusfn), PCI_FUNC(devbusfn));
|
|
|
|
|
|
+ PCI_BUS(devbusfn),
|
|
|
|
+ PCI_DEV(devbusfn),
|
|
|
|
+ PCI_FUNC(devbusfn));
|
|
|
|
|
|
/* Enable I/O decoding as well, PCI viudeo boards
|
|
/* Enable I/O decoding as well, PCI viudeo boards
|
|
* support I/O accesses, but they provide no
|
|
* support I/O accesses, but they provide no
|
|
* bar register for this since the ports are fixed.
|
|
* bar register for this since the ports are fixed.
|
|
*/
|
|
*/
|
|
- pci_write_config_word(devbusfn, PCI_COMMAND, PCI_COMMAND_MEMORY | PCI_COMMAND_IO | PCI_COMMAND_MASTER);
|
|
|
|
|
|
+ pci_write_config_word(devbusfn,
|
|
|
|
+ PCI_COMMAND,
|
|
|
|
+ PCI_COMMAND_MEMORY |
|
|
|
|
+ PCI_COMMAND_IO |
|
|
|
|
+ PCI_COMMAND_MASTER);
|
|
|
|
|
|
/* Test the ROM decoder, do the device support a rom? */
|
|
/* Test the ROM decoder, do the device support a rom? */
|
|
pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &old);
|
|
pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &old);
|
|
- pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, (u32)PCI_ROM_ADDRESS_MASK);
|
|
|
|
|
|
+ pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS,
|
|
|
|
+ (u32)PCI_ROM_ADDRESS_MASK);
|
|
pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &addr);
|
|
pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &addr);
|
|
pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, old);
|
|
pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, old);
|
|
|
|
|
|
@@ -117,13 +125,14 @@ static u32 probe_pci_video(void)
|
|
}
|
|
}
|
|
|
|
|
|
/* device have a rom */
|
|
/* device have a rom */
|
|
- if (pci_shadow_rom(devbusfn, (void*)0xc0000)) {
|
|
|
|
|
|
+ if (pci_shadow_rom(devbusfn, (void *)0xc0000)) {
|
|
printf("Shadowing of PCI VGA BIOS failed\n");
|
|
printf("Shadowing of PCI VGA BIOS failed\n");
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
/* Now enable lagacy VGA port access */
|
|
/* Now enable lagacy VGA port access */
|
|
- if (pci_enable_legacy_video_ports(pci_bus_to_hose(PCI_BUS(devbusfn)))) {
|
|
|
|
|
|
+ hose = pci_bus_to_hose(PCI_BUS(devbusfn));
|
|
|
|
+ if (pci_enable_legacy_video_ports(hose)) {
|
|
printf("PCI VGA enable failed\n");
|
|
printf("PCI VGA enable failed\n");
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
@@ -131,7 +140,7 @@ static u32 probe_pci_video(void)
|
|
|
|
|
|
/* return the pci device info, that we'll need later */
|
|
/* return the pci device info, that we'll need later */
|
|
return PCI_BUS(devbusfn) << 8 |
|
|
return PCI_BUS(devbusfn) << 8 |
|
|
- PCI_DEV(devbusfn) << 3 | (PCI_FUNC(devbusfn)&7);
|
|
|
|
|
|
+ PCI_DEV(devbusfn) << 3 | (PCI_FUNC(devbusfn) & 7);
|
|
}
|
|
}
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
@@ -142,13 +151,17 @@ static int probe_isa_video(void)
|
|
u32 ptr;
|
|
u32 ptr;
|
|
char *buf;
|
|
char *buf;
|
|
|
|
|
|
- if (0 == (ptr = isa_map_rom(0xc0000, 0x8000))) {
|
|
|
|
|
|
+ ptr = isa_map_rom(0xc0000, 0x8000);
|
|
|
|
+
|
|
|
|
+ if (!ptr)
|
|
return -1;
|
|
return -1;
|
|
- }
|
|
|
|
- if (NULL == (buf=malloc(0x8000))) {
|
|
|
|
|
|
+
|
|
|
|
+ buf = malloc(0x8000);
|
|
|
|
+ if (!buf) {
|
|
isa_unmap_rom(ptr);
|
|
isa_unmap_rom(ptr);
|
|
return -1;
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
+
|
|
if (readw(ptr) != 0xaa55) {
|
|
if (readw(ptr) != 0xaa55) {
|
|
free(buf);
|
|
free(buf);
|
|
isa_unmap_rom(ptr);
|
|
isa_unmap_rom(ptr);
|
|
@@ -156,9 +169,9 @@ static int probe_isa_video(void)
|
|
}
|
|
}
|
|
|
|
|
|
/* shadow the rom */
|
|
/* shadow the rom */
|
|
- memcpy(buf, (void*)ptr, 0x8000);
|
|
|
|
|
|
+ memcpy(buf, (void *)ptr, 0x8000);
|
|
isa_unmap_rom(ptr);
|
|
isa_unmap_rom(ptr);
|
|
- memcpy((void*)0xc0000, buf, 0x8000);
|
|
|
|
|
|
+ memcpy((void *)0xc0000, buf, 0x8000);
|
|
|
|
|
|
free(buf);
|
|
free(buf);
|
|
|
|
|
|
@@ -168,35 +181,35 @@ static int probe_isa_video(void)
|
|
int video_bios_init(void)
|
|
int video_bios_init(void)
|
|
{
|
|
{
|
|
struct pt_regs regs;
|
|
struct pt_regs regs;
|
|
|
|
+ int size;
|
|
|
|
+ int i;
|
|
|
|
+ u8 sum;
|
|
|
|
|
|
/* clear the video bios area in case we warmbooted */
|
|
/* clear the video bios area in case we warmbooted */
|
|
- memset((void*)0xc0000, 0, 0x8000);
|
|
|
|
|
|
+ memset((void *)0xc0000, 0, 0x8000);
|
|
memset(®s, 0, sizeof(struct pt_regs));
|
|
memset(®s, 0, sizeof(struct pt_regs));
|
|
|
|
|
|
- if (probe_isa_video()) {
|
|
|
|
|
|
+ if (probe_isa_video())
|
|
/* No ISA board found, try the PCI bus */
|
|
/* No ISA board found, try the PCI bus */
|
|
regs.eax = probe_pci_video();
|
|
regs.eax = probe_pci_video();
|
|
- }
|
|
|
|
|
|
|
|
/* Did we succeed in mapping any video bios */
|
|
/* Did we succeed in mapping any video bios */
|
|
if (readw(0xc0000) == 0xaa55) {
|
|
if (readw(0xc0000) == 0xaa55) {
|
|
- int size;
|
|
|
|
- int i;
|
|
|
|
- u8 sum;
|
|
|
|
-
|
|
|
|
PRINTF("Found video bios signature\n");
|
|
PRINTF("Found video bios signature\n");
|
|
- size = 512*readb(0xc0002);
|
|
|
|
|
|
+ size = readb(0xc0002) * 512;
|
|
PRINTF("size %d\n", size);
|
|
PRINTF("size %d\n", size);
|
|
- sum=0;
|
|
|
|
- for (i=0;i<size;i++) {
|
|
|
|
|
|
+ sum = 0;
|
|
|
|
+
|
|
|
|
+ for (i = 0; i < size; i++)
|
|
sum += readb(0xc0000 + i);
|
|
sum += readb(0xc0000 + i);
|
|
- }
|
|
|
|
- PRINTF("Checksum is %sOK\n",sum?"NOT ":"");
|
|
|
|
- if (sum) {
|
|
|
|
|
|
+
|
|
|
|
+ PRINTF("Checksum is %sOK\n", sum ? "NOT " : "");
|
|
|
|
+
|
|
|
|
+ if (sum)
|
|
return 1;
|
|
return 1;
|
|
- }
|
|
|
|
|
|
|
|
- /* some video bioses (ATI Mach64) seem to think that
|
|
|
|
|
|
+ /*
|
|
|
|
+ * Some video bioses (ATI Mach64) seem to think that
|
|
* the original int 10 handler is always at
|
|
* the original int 10 handler is always at
|
|
* 0xf000:0xf065 , place an iret instruction there
|
|
* 0xf000:0xf065 , place an iret instruction there
|
|
*/
|
|
*/
|
|
@@ -205,13 +218,15 @@ int video_bios_init(void)
|
|
regs.esp = 0x8000;
|
|
regs.esp = 0x8000;
|
|
regs.xss = 0x2000;
|
|
regs.xss = 0x2000;
|
|
enter_realmode(0xc000, 3, ®s, ®s);
|
|
enter_realmode(0xc000, 3, ®s, ®s);
|
|
|
|
+
|
|
PRINTF("INT 0x10 vector after: %04x:%04x\n",
|
|
PRINTF("INT 0x10 vector after: %04x:%04x\n",
|
|
readw(0x42), readw(0x40));
|
|
readw(0x42), readw(0x40));
|
|
- PRINTF("BIOS returned %scarry\n", regs.eflags & 1?"":"NOT ");
|
|
|
|
|
|
+ PRINTF("BIOS returned %scarry\n",
|
|
|
|
+ regs.eflags & 0x00000001 ? "" : "NOT ");
|
|
#ifdef PCI_BIOS_DEBUG
|
|
#ifdef PCI_BIOS_DEBUG
|
|
print_bios_bios_stat();
|
|
print_bios_bios_stat();
|
|
#endif
|
|
#endif
|
|
- return (regs.eflags & 1);
|
|
|
|
|
|
+ return regs.eflags & 0x00000001;
|
|
|
|
|
|
}
|
|
}
|
|
|
|
|