arch/x86/lib/video_bios.c

   1 /*
   2  * (C) Copyright 2002
   3  * Daniel Engström, Omicron Ceti AB, <daniel@omicron.se>
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   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.
  12  *
  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.
  17  *
  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,
  21  * MA 02111-1307 USA
  22  */
  23
  24 #include <common.h>
  25 #include <pci.h>
  26 #include <malloc.h>
  27 #include <asm/ptrace.h>
  28 #include <asm/realmode.h>
  29 #include <asm/io.h>
  30 #include <asm/pci.h>
  31 #include "bios.h"
  32
  33 #undef PCI_BIOS_DEBUG
  34 #undef VGA_BIOS_DEBUG
  35
  36 #ifdef  VGA_BIOS_DEBUG
  37 #define PRINTF(fmt, args...)    printf(fmt, ##args)
  38 #else
  39 #define PRINTF(fmt, args...)
  40 #endif
  41
  42 #define PCI_CLASS_VIDEO                 3
  43 #define PCI_CLASS_VIDEO_STD             0
  44 #define PCI_CLASS_VIDEO_PROG_IF_VGA     0
  45
  46 DEFINE_PCI_DEVICE_TABLE(supported) = {
  47         {PCI_VIDEO_VENDOR_ID, PCI_VIDEO_DEVICE_ID},
  48         {}
  49 };
  50
  51 static u32 probe_pci_video(void)
  52 {
  53         struct pci_controller *hose;
  54         pci_dev_t devbusfn = pci_find_devices(supported, 0);
  55
  56         if ((devbusfn != -1)) {
  57                 u32 old;
  58                 u32 addr;
  59
  60                 /* PCI video device detected */
  61                 printf("Found PCI VGA device at %02x.%02x.%x\n",
  62                        PCI_BUS(devbusfn),
  63                        PCI_DEV(devbusfn),
  64                        PCI_FUNC(devbusfn));
  65
  66                 /* Enable I/O decoding as well, PCI viudeo boards
  67                  * support I/O accesses, but they provide no
  68                  * bar register for this since the ports are fixed.
  69                  */
  70                 pci_write_config_word(devbusfn,
  71                                       PCI_COMMAND,
  72                                       PCI_COMMAND_MEMORY |
  73                                       PCI_COMMAND_IO |
  74                                       PCI_COMMAND_MASTER);
  75
  76                 /* Test the ROM decoder, do the device support a rom? */
  77                 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &old);
  78                 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS,
  79                                        (u32)PCI_ROM_ADDRESS_MASK);
  80                 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &addr);
  81                 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, old);
  82
  83                 if (!addr) {
  84                         printf("PCI VGA have no ROM?\n");
  85                         return 0;
  86                 }
  87
  88                 /* device have a rom */
  89                 if (pci_shadow_rom(devbusfn, (void *)0xc0000)) {
  90                         printf("Shadowing of PCI VGA BIOS failed\n");
  91                         return 0;
  92                 }
  93
  94                 /* Now enable lagacy VGA port access */
  95                 hose = pci_bus_to_hose(PCI_BUS(devbusfn));
  96                 if (pci_enable_legacy_video_ports(hose)) {
  97                         printf("PCI VGA enable failed\n");
  98                         return 0;
  99                 }
 100
 101
 102                 /* return the pci device info, that we'll need later */
 103                 return PCI_BUS(devbusfn) << 8 |
 104                         PCI_DEV(devbusfn) << 3 | (PCI_FUNC(devbusfn) & 7);
 105         }
 106
 107         return 0;
 108 }
 109
 110 static int probe_isa_video(void)
 111 {
 112         u32 ptr;
 113         char *buf;
 114
 115         ptr = isa_map_rom(0xc0000, 0x8000);
 116
 117         if (!ptr)
 118                 return -1;
 119
 120         buf = malloc(0x8000);
 121         if (!buf) {
 122                 isa_unmap_rom(ptr);
 123                 return -1;
 124         }
 125
 126         if (readw(ptr) != 0xaa55) {
 127                 free(buf);
 128                 isa_unmap_rom(ptr);
 129                 return -1;
 130         }
 131
 132         /* shadow the rom */
 133         memcpy(buf, (void *)ptr, 0x8000);
 134         isa_unmap_rom(ptr);
 135         memcpy((void *)0xc0000, buf, 0x8000);
 136
 137         free(buf);
 138
 139         return 0;
 140 }
 141
 142 int video_bios_init(void)
 143 {
 144         struct pt_regs regs;
 145         int size;
 146         int i;
 147         u8 sum;
 148
 149         /* clear the video bios area in case we warmbooted */
 150         memset((void *)0xc0000, 0, 0x8000);
 151         memset(&regs, 0, sizeof(struct pt_regs));
 152
 153         if (probe_isa_video())
 154                 /* No ISA board found, try the PCI bus */
 155                 regs.eax = probe_pci_video();
 156
 157         /* Did we succeed in mapping any video bios */
 158         if (readw(0xc0000) == 0xaa55) {
 159                 PRINTF("Found video bios signature\n");
 160                 size = readb(0xc0002) * 512;
 161                 PRINTF("size %d\n", size);
 162                 sum = 0;
 163
 164                 for (i = 0; i < size; i++)
 165                         sum += readb(0xc0000 + i);
 166
 167                 PRINTF("Checksum is %sOK\n", sum ? "NOT " : "");
 168
 169                 if (sum)
 170                         return 1;
 171
 172                 /*
 173                  * Some video bioses (ATI Mach64) seem to think that
 174                  * the original int 10 handler is always at
 175                  * 0xf000:0xf065 , place an iret instruction there
 176                  */
 177                 writeb(0xcf, 0xff065);
 178
 179                 regs.esp = 0x8000;
 180                 regs.xss = 0x2000;
 181                 enter_realmode(0xc000, 3, &regs, &regs);
 182
 183                 PRINTF("INT 0x10 vector after:  %04x:%04x\n",
 184                        readw(0x42), readw(0x40));
 185                 PRINTF("BIOS returned %scarry\n",
 186                        regs.eflags & 0x00000001 ? "" : "NOT ");
 187 #ifdef PCI_BIOS_DEBUG
 188                 print_bios_bios_stat();
 189 #endif
 190                 return regs.eflags & 0x00000001;
 191
 192         }
 193
 194         return 1;
 195
 196 }