| /**************************************************************************** |
| * |
| * Video BOOT Graphics Card POST Module |
| * |
| * ======================================================================== |
| * Copyright (C) 2007 Freescale Semiconductor, Inc. |
| * Jason Jin <Jason.jin@freescale.com> |
| * |
| * Copyright (C) 1991-2004 SciTech Software, Inc. All rights reserved. |
| * |
| * This file may be distributed and/or modified under the terms of the |
| * GNU General Public License version 2.0 as published by the Free |
| * Software Foundation and appearing in the file LICENSE.GPL included |
| * in the packaging of this file. |
| * |
| * Licensees holding a valid Commercial License for this product from |
| * SciTech Software, Inc. may use this file in accordance with the |
| * Commercial License Agreement provided with the Software. |
| * |
| * This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING |
| * THE WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
| * PURPOSE. |
| * |
| * See http://www.scitechsoft.com/license/ for information about |
| * the licensing options available and how to purchase a Commercial |
| * License Agreement. |
| * |
| * Contact license@scitechsoft.com if any conditions of this licensing |
| * are not clear to you, or you have questions about licensing options. |
| * |
| * ======================================================================== |
| * |
| * Language: ANSI C |
| * Environment: Linux Kernel |
| * Developer: Kendall Bennett |
| * |
| * Description: Module to implement booting PCI/AGP controllers on the |
| * bus. We use the x86 real mode emulator to run the BIOS on |
| * graphics controllers to bring the cards up. |
| * |
| * Note that at present this module does *not* support |
| * multiple controllers. |
| * |
| * The orignal name of this file is warmboot.c. |
| * Jason ported this file to u-boot to run the ATI video card |
| * BIOS in u-boot. |
| ****************************************************************************/ |
| #include <common.h> |
| #include <bios_emul.h> |
| #include <errno.h> |
| #include <malloc.h> |
| #include <vbe.h> |
| #include "biosemui.h" |
| |
| /* Length of the BIOS image */ |
| #define MAX_BIOSLEN (128 * 1024L) |
| |
| /* Place to save PCI BAR's that we change and later restore */ |
| static u32 saveROMBaseAddress; |
| static u32 saveBaseAddress10; |
| static u32 saveBaseAddress14; |
| static u32 saveBaseAddress18; |
| static u32 saveBaseAddress20; |
| |
| /* Addres im memory of VBE region */ |
| const int vbe_offset = 0x2000; |
| |
| #ifdef CONFIG_FRAMEBUFFER_SET_VESA_MODE |
| static const void *bios_ptr(const void *buf, BE_VGAInfo *vga_info, |
| u32 x86_dword_ptr) |
| { |
| u32 seg_ofs, flat; |
| |
| seg_ofs = le32_to_cpu(x86_dword_ptr); |
| flat = ((seg_ofs & 0xffff0000) >> 12) | (seg_ofs & 0xffff); |
| if (flat >= 0xc0000) |
| return vga_info->BIOSImage + flat - 0xc0000; |
| else |
| return buf + (flat - vbe_offset); |
| } |
| |
| static int atibios_debug_mode(BE_VGAInfo *vga_info, RMREGS *regs, |
| int vesa_mode, struct vbe_mode_info *mode_info) |
| { |
| void *buffer = (void *)(M.mem_base + vbe_offset); |
| u16 buffer_seg = (((unsigned long)vbe_offset) >> 4) & 0xff00; |
| u16 buffer_adr = ((unsigned long)vbe_offset) & 0xffff; |
| struct vesa_mode_info *vm; |
| struct vbe_info *info; |
| const u16 *modes_bios, *ptr; |
| u16 *modes; |
| int size; |
| |
| debug("VBE: Getting information\n"); |
| regs->e.eax = VESA_GET_INFO; |
| regs->e.esi = buffer_seg; |
| regs->e.edi = buffer_adr; |
| info = buffer; |
| memset(info, '\0', sizeof(*info)); |
| strcpy(info->signature, "VBE2"); |
| BE_int86(0x10, regs, regs); |
| if (regs->e.eax != 0x4f) { |
| debug("VESA_GET_INFO: error %x\n", regs->e.eax); |
| return -ENOSYS; |
| } |
| debug("version %x\n", le16_to_cpu(info->version)); |
| debug("oem '%s'\n", (char *)bios_ptr(buffer, vga_info, |
| info->oem_string_ptr)); |
| debug("vendor '%s'\n", (char *)bios_ptr(buffer, vga_info, |
| info->vendor_name_ptr)); |
| debug("product '%s'\n", (char *)bios_ptr(buffer, vga_info, |
| info->product_name_ptr)); |
| debug("rev '%s'\n", (char *)bios_ptr(buffer, vga_info, |
| info->product_rev_ptr)); |
| modes_bios = bios_ptr(buffer, vga_info, info->modes_ptr); |
| debug("Modes: "); |
| for (ptr = modes_bios; *ptr != 0xffff; ptr++) |
| debug("%x ", le16_to_cpu(*ptr)); |
| debug("\nmemory %dMB\n", le16_to_cpu(info->total_memory) >> 4); |
| size = (ptr - modes_bios) * sizeof(u16) + 2; |
| modes = malloc(size); |
| if (!modes) |
| return -ENOMEM; |
| memcpy(modes, modes_bios, size); |
| |
| regs->e.eax = VESA_GET_CUR_MODE; |
| BE_int86(0x10, regs, regs); |
| if (regs->e.eax != 0x4f) { |
| debug("VESA_GET_CUR_MODE: error %x\n", regs->e.eax); |
| return -ENOSYS; |
| } |
| debug("Current mode %x\n", regs->e.ebx); |
| |
| for (ptr = modes; *ptr != 0xffff; ptr++) { |
| int mode = le16_to_cpu(*ptr); |
| bool linear_ok; |
| int attr; |
| |
| break; |
| debug("Mode %x: ", mode); |
| memset(buffer, '\0', sizeof(struct vbe_mode_info)); |
| regs->e.eax = VESA_GET_MODE_INFO; |
| regs->e.ebx = 0; |
| regs->e.ecx = mode; |
| regs->e.edx = 0; |
| regs->e.esi = buffer_seg; |
| regs->e.edi = buffer_adr; |
| BE_int86(0x10, regs, regs); |
| if (regs->e.eax != 0x4f) { |
| debug("VESA_GET_MODE_INFO: error %x\n", regs->e.eax); |
| continue; |
| } |
| memcpy(mode_info->mode_info_block, buffer, |
| sizeof(struct vesa_mode_info)); |
| mode_info->valid = true; |
| vm = &mode_info->vesa; |
| attr = le16_to_cpu(vm->mode_attributes); |
| linear_ok = attr & 0x80; |
| debug("res %d x %d, %d bpp, mm %d, (Linear %s, attr %02x)\n", |
| le16_to_cpu(vm->x_resolution), |
| le16_to_cpu(vm->y_resolution), |
| vm->bits_per_pixel, vm->memory_model, |
| linear_ok ? "OK" : "not available", |
| attr); |
| debug("\tRGB pos=%d,%d,%d, size=%d,%d,%d\n", |
| vm->red_mask_pos, vm->green_mask_pos, vm->blue_mask_pos, |
| vm->red_mask_size, vm->green_mask_size, |
| vm->blue_mask_size); |
| } |
| |
| return 0; |
| } |
| |
| static int atibios_set_vesa_mode(RMREGS *regs, int vesa_mode, |
| struct vbe_mode_info *mode_info) |
| { |
| void *buffer = (void *)(M.mem_base + vbe_offset); |
| u16 buffer_seg = (((unsigned long)vbe_offset) >> 4) & 0xff00; |
| u16 buffer_adr = ((unsigned long)vbe_offset) & 0xffff; |
| struct vesa_mode_info *vm; |
| |
| debug("VBE: Setting VESA mode %#04x\n", vesa_mode); |
| regs->e.eax = VESA_SET_MODE; |
| regs->e.ebx = vesa_mode; |
| /* request linear framebuffer mode and don't clear display */ |
| regs->e.ebx |= (1 << 14) | (1 << 15); |
| BE_int86(0x10, regs, regs); |
| if (regs->e.eax != 0x4f) { |
| debug("VESA_SET_MODE: error %x\n", regs->e.eax); |
| return -ENOSYS; |
| } |
| |
| memset(buffer, '\0', sizeof(struct vbe_mode_info)); |
| debug("VBE: Geting info for VESA mode %#04x\n", vesa_mode); |
| regs->e.eax = VESA_GET_MODE_INFO; |
| regs->e.ecx = vesa_mode; |
| regs->e.esi = buffer_seg; |
| regs->e.edi = buffer_adr; |
| BE_int86(0x10, regs, regs); |
| if (regs->e.eax != 0x4f) { |
| debug("VESA_GET_MODE_INFO: error %x\n", regs->e.eax); |
| return -ENOSYS; |
| } |
| |
| memcpy(mode_info->mode_info_block, buffer, |
| sizeof(struct vesa_mode_info)); |
| mode_info->valid = true; |
| mode_info->video_mode = vesa_mode; |
| vm = &mode_info->vesa; |
| vm->x_resolution = le16_to_cpu(vm->x_resolution); |
| vm->y_resolution = le16_to_cpu(vm->y_resolution); |
| vm->bytes_per_scanline = le16_to_cpu(vm->bytes_per_scanline); |
| vm->phys_base_ptr = le32_to_cpu(vm->phys_base_ptr); |
| vm->mode_attributes = le16_to_cpu(vm->mode_attributes); |
| debug("VBE: Init complete\n"); |
| |
| return 0; |
| } |
| #endif /* CONFIG_FRAMEBUFFER_SET_VESA_MODE */ |
| |
| /**************************************************************************** |
| PARAMETERS: |
| pcidev - PCI device info for the video card on the bus to boot |
| vga_info - BIOS emulator VGA info structure |
| |
| REMARKS: |
| This function executes the BIOS POST code on the controller. We assume that |
| at this stage the controller has its I/O and memory space enabled and |
| that all other controllers are in a disabled state. |
| ****************************************************************************/ |
| #ifdef CONFIG_DM_PCI |
| static void PCI_doBIOSPOST(struct udevice *pcidev, BE_VGAInfo *vga_info, |
| int vesa_mode, struct vbe_mode_info *mode_info) |
| #else |
| static void PCI_doBIOSPOST(pci_dev_t pcidev, BE_VGAInfo *vga_info, |
| int vesa_mode, struct vbe_mode_info *mode_info) |
| #endif |
| { |
| RMREGS regs; |
| RMSREGS sregs; |
| #ifdef CONFIG_DM_PCI |
| pci_dev_t bdf; |
| #endif |
| |
| /* Determine the value to store in AX for BIOS POST. Per the PCI specs, |
| AH must contain the bus and AL must contain the devfn, encoded as |
| (dev << 3) | fn |
| */ |
| memset(®s, 0, sizeof(regs)); |
| memset(&sregs, 0, sizeof(sregs)); |
| #ifdef CONFIG_DM_PCI |
| bdf = dm_pci_get_bdf(pcidev); |
| regs.x.ax = (int)PCI_BUS(bdf) << 8 | |
| (int)PCI_DEV(bdf) << 3 | (int)PCI_FUNC(bdf); |
| #else |
| regs.x.ax = ((int)PCI_BUS(pcidev) << 8) | |
| ((int)PCI_DEV(pcidev) << 3) | (int)PCI_FUNC(pcidev); |
| #endif |
| /*Setup the X86 emulator for the VGA BIOS*/ |
| BE_setVGA(vga_info); |
| |
| /*Execute the BIOS POST code*/ |
| BE_callRealMode(0xC000, 0x0003, ®s, &sregs); |
| |
| /*Cleanup and exit*/ |
| BE_getVGA(vga_info); |
| |
| #ifdef CONFIG_FRAMEBUFFER_SET_VESA_MODE |
| /* Useful for debugging */ |
| if (0) |
| atibios_debug_mode(vga_info, ®s, vesa_mode, mode_info); |
| if (vesa_mode != -1) |
| atibios_set_vesa_mode(®s, vesa_mode, mode_info); |
| #endif |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| pcidev - PCI device info for the video card on the bus |
| bar - Place to return the base address register offset to use |
| |
| RETURNS: |
| The address to use to map the secondary BIOS (AGP devices) |
| |
| REMARKS: |
| Searches all the PCI base address registers for the device looking for a |
| memory mapping that is large enough to hold our ROM BIOS. We usually end up |
| finding the framebuffer mapping (usually BAR 0x10), and we use this mapping |
| to map the BIOS for the device into. We use a mapping that is already |
| assigned to the device to ensure the memory range will be passed through |
| by any PCI->PCI or AGP->PCI bridge that may be present. |
| |
| NOTE: Usually this function is only used for AGP devices, but it may be |
| used for PCI devices that have already been POST'ed and the BIOS |
| ROM base address has been zero'ed out. |
| |
| NOTE: This function leaves the original memory aperture disabled by leaving |
| it programmed to all 1's. It must be restored to the correct value |
| later. |
| ****************************************************************************/ |
| #ifdef CONFIG_DM_PCI |
| static u32 PCI_findBIOSAddr(struct udevice *pcidev, int *bar) |
| #else |
| static u32 PCI_findBIOSAddr(pci_dev_t pcidev, int *bar) |
| #endif |
| { |
| u32 base, size; |
| |
| for (*bar = 0x10; *bar <= 0x14; (*bar) += 4) { |
| #ifdef CONFIG_DM_PCI |
| dm_pci_read_config32(pcidev, *bar, &base); |
| #else |
| pci_read_config_dword(pcidev, *bar, &base); |
| #endif |
| if (!(base & 0x1)) { |
| #ifdef CONFIG_DM_PCI |
| dm_pci_write_config32(pcidev, *bar, 0xFFFFFFFF); |
| dm_pci_read_config32(pcidev, *bar, &size); |
| #else |
| pci_write_config_dword(pcidev, *bar, 0xFFFFFFFF); |
| pci_read_config_dword(pcidev, *bar, &size); |
| #endif |
| size = ~(size & ~0xFF) + 1; |
| if (size >= MAX_BIOSLEN) |
| return base & ~0xFF; |
| } |
| } |
| return 0; |
| } |
| |
| /**************************************************************************** |
| REMARKS: |
| Some non-x86 Linux kernels map PCI relocateable I/O to values that |
| are above 64K, which will not work with the BIOS image that requires |
| the offset for the I/O ports to be a maximum of 16-bits. Ideally |
| someone should fix the kernel to map the I/O ports for VGA compatible |
| devices to a different location (or just all I/O ports since it is |
| unlikely you can have enough devices in the machine to use up all |
| 64K of the I/O space - a total of more than 256 cards would be |
| necessary). |
| |
| Anyway to fix this we change all I/O mapped base registers and |
| chop off the top bits. |
| ****************************************************************************/ |
| #ifdef CONFIG_DM_PCI |
| static void PCI_fixupIObase(struct udevice *pcidev, int reg, u32 *base) |
| #else |
| static void PCI_fixupIObase(pci_dev_t pcidev, int reg, u32 * base) |
| #endif |
| { |
| if ((*base & 0x1) && (*base > 0xFFFE)) { |
| *base &= 0xFFFF; |
| #ifdef CONFIG_DM_PCI |
| dm_pci_write_config32(pcidev, reg, *base); |
| #else |
| pci_write_config_dword(pcidev, reg, *base); |
| #endif |
| |
| } |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| pcidev - PCI device info for the video card on the bus |
| |
| RETURNS: |
| Pointers to the mapped BIOS image |
| |
| REMARKS: |
| Maps a pointer to the BIOS image on the graphics card on the PCI bus. |
| ****************************************************************************/ |
| #ifdef CONFIG_DM_PCI |
| void *PCI_mapBIOSImage(struct udevice *pcidev) |
| #else |
| void *PCI_mapBIOSImage(pci_dev_t pcidev) |
| #endif |
| { |
| u32 BIOSImageBus; |
| int BIOSImageBAR; |
| u8 *BIOSImage; |
| |
| /*Save PCI BAR registers that might get changed*/ |
| #ifdef CONFIG_DM_PCI |
| dm_pci_read_config32(pcidev, PCI_ROM_ADDRESS, &saveROMBaseAddress); |
| dm_pci_read_config32(pcidev, PCI_BASE_ADDRESS_0, &saveBaseAddress10); |
| dm_pci_read_config32(pcidev, PCI_BASE_ADDRESS_1, &saveBaseAddress14); |
| dm_pci_read_config32(pcidev, PCI_BASE_ADDRESS_2, &saveBaseAddress18); |
| dm_pci_read_config32(pcidev, PCI_BASE_ADDRESS_4, &saveBaseAddress20); |
| #else |
| pci_read_config_dword(pcidev, PCI_ROM_ADDRESS, &saveROMBaseAddress); |
| pci_read_config_dword(pcidev, PCI_BASE_ADDRESS_0, &saveBaseAddress10); |
| pci_read_config_dword(pcidev, PCI_BASE_ADDRESS_1, &saveBaseAddress14); |
| pci_read_config_dword(pcidev, PCI_BASE_ADDRESS_2, &saveBaseAddress18); |
| pci_read_config_dword(pcidev, PCI_BASE_ADDRESS_4, &saveBaseAddress20); |
| #endif |
| |
| /*Fix up I/O base registers to less than 64K */ |
| if(saveBaseAddress14 != 0) |
| PCI_fixupIObase(pcidev, PCI_BASE_ADDRESS_1, &saveBaseAddress14); |
| else |
| PCI_fixupIObase(pcidev, PCI_BASE_ADDRESS_4, &saveBaseAddress20); |
| |
| /* Some cards have problems that stop us from being able to read the |
| BIOS image from the ROM BAR. To fix this we have to do some chipset |
| specific programming for different cards to solve this problem. |
| */ |
| |
| BIOSImageBus = PCI_findBIOSAddr(pcidev, &BIOSImageBAR); |
| if (BIOSImageBus == 0) { |
| printf("Find bios addr error\n"); |
| return NULL; |
| } |
| |
| #ifdef CONFIG_DM_PCI |
| BIOSImage = dm_pci_bus_to_virt(pcidev, BIOSImageBus, |
| PCI_REGION_MEM, 0, MAP_NOCACHE); |
| |
| /*Change the PCI BAR registers to map it onto the bus.*/ |
| dm_pci_write_config32(pcidev, BIOSImageBAR, 0); |
| dm_pci_write_config32(pcidev, PCI_ROM_ADDRESS, BIOSImageBus | 0x1); |
| #else |
| BIOSImage = pci_bus_to_virt(pcidev, BIOSImageBus, |
| PCI_REGION_MEM, 0, MAP_NOCACHE); |
| |
| /*Change the PCI BAR registers to map it onto the bus.*/ |
| pci_write_config_dword(pcidev, BIOSImageBAR, 0); |
| pci_write_config_dword(pcidev, PCI_ROM_ADDRESS, BIOSImageBus | 0x1); |
| #endif |
| udelay(1); |
| |
| /*Check that the BIOS image is valid. If not fail, or return the |
| compiled in BIOS image if that option was enabled |
| */ |
| if (BIOSImage[0] != 0x55 || BIOSImage[1] != 0xAA || BIOSImage[2] == 0) { |
| return NULL; |
| } |
| |
| return BIOSImage; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| pcidev - PCI device info for the video card on the bus |
| |
| REMARKS: |
| Unmaps the BIOS image for the device and restores framebuffer mappings |
| ****************************************************************************/ |
| #ifdef CONFIG_DM_PCI |
| void PCI_unmapBIOSImage(struct udevice *pcidev, void *BIOSImage) |
| { |
| dm_pci_write_config32(pcidev, PCI_ROM_ADDRESS, saveROMBaseAddress); |
| dm_pci_write_config32(pcidev, PCI_BASE_ADDRESS_0, saveBaseAddress10); |
| dm_pci_write_config32(pcidev, PCI_BASE_ADDRESS_1, saveBaseAddress14); |
| dm_pci_write_config32(pcidev, PCI_BASE_ADDRESS_2, saveBaseAddress18); |
| dm_pci_write_config32(pcidev, PCI_BASE_ADDRESS_4, saveBaseAddress20); |
| } |
| #else |
| void PCI_unmapBIOSImage(pci_dev_t pcidev, void *BIOSImage) |
| { |
| pci_write_config_dword(pcidev, PCI_ROM_ADDRESS, saveROMBaseAddress); |
| pci_write_config_dword(pcidev, PCI_BASE_ADDRESS_0, saveBaseAddress10); |
| pci_write_config_dword(pcidev, PCI_BASE_ADDRESS_1, saveBaseAddress14); |
| pci_write_config_dword(pcidev, PCI_BASE_ADDRESS_2, saveBaseAddress18); |
| pci_write_config_dword(pcidev, PCI_BASE_ADDRESS_4, saveBaseAddress20); |
| } |
| #endif |
| |
| /**************************************************************************** |
| PARAMETERS: |
| pcidev - PCI device info for the video card on the bus to boot |
| VGAInfo - BIOS emulator VGA info structure |
| |
| RETURNS: |
| true if successfully initialised, false if not. |
| |
| REMARKS: |
| Loads and POST's the display controllers BIOS, directly from the BIOS |
| image we can extract over the PCI bus. |
| ****************************************************************************/ |
| #ifdef CONFIG_DM_PCI |
| static int PCI_postController(struct udevice *pcidev, uchar *bios_rom, |
| int bios_len, BE_VGAInfo *vga_info, |
| int vesa_mode, struct vbe_mode_info *mode_info) |
| #else |
| static int PCI_postController(pci_dev_t pcidev, uchar *bios_rom, int bios_len, |
| BE_VGAInfo *vga_info, int vesa_mode, |
| struct vbe_mode_info *mode_info) |
| #endif |
| { |
| u32 bios_image_len; |
| uchar *mapped_bios; |
| uchar *copy_of_bios; |
| #ifdef CONFIG_DM_PCI |
| pci_dev_t bdf; |
| #endif |
| |
| if (bios_rom) { |
| copy_of_bios = bios_rom; |
| bios_image_len = bios_len; |
| } else { |
| /* |
| * Allocate memory to store copy of BIOS from display |
| * controller |
| */ |
| mapped_bios = PCI_mapBIOSImage(pcidev); |
| if (mapped_bios == NULL) { |
| printf("videoboot: Video ROM failed to map!\n"); |
| return false; |
| } |
| |
| bios_image_len = mapped_bios[2] * 512; |
| |
| copy_of_bios = malloc(bios_image_len); |
| if (copy_of_bios == NULL) { |
| printf("videoboot: Out of memory!\n"); |
| return false; |
| } |
| memcpy(copy_of_bios, mapped_bios, bios_image_len); |
| PCI_unmapBIOSImage(pcidev, mapped_bios); |
| } |
| |
| /*Save information in vga_info structure*/ |
| #ifdef CONFIG_DM_PCI |
| bdf = dm_pci_get_bdf(pcidev); |
| vga_info->function = PCI_FUNC(bdf); |
| vga_info->device = PCI_DEV(bdf); |
| vga_info->bus = PCI_BUS(bdf); |
| #else |
| vga_info->function = PCI_FUNC(pcidev); |
| vga_info->device = PCI_DEV(pcidev); |
| vga_info->bus = PCI_BUS(pcidev); |
| #endif |
| vga_info->pcidev = pcidev; |
| vga_info->BIOSImage = copy_of_bios; |
| vga_info->BIOSImageLen = bios_image_len; |
| |
| /*Now execute the BIOS POST for the device*/ |
| if (copy_of_bios[0] != 0x55 || copy_of_bios[1] != 0xAA) { |
| printf("videoboot: Video ROM image is invalid!\n"); |
| return false; |
| } |
| |
| PCI_doBIOSPOST(pcidev, vga_info, vesa_mode, mode_info); |
| |
| /*Reset the size of the BIOS image to the final size*/ |
| vga_info->BIOSImageLen = copy_of_bios[2] * 512; |
| return true; |
| } |
| |
| #ifdef CONFIG_DM_PCI |
| int biosemu_setup(struct udevice *pcidev, BE_VGAInfo **vga_infop) |
| #else |
| int biosemu_setup(pci_dev_t pcidev, BE_VGAInfo **vga_infop) |
| #endif |
| { |
| BE_VGAInfo *VGAInfo; |
| #ifdef CONFIG_DM_PCI |
| pci_dev_t bdf = dm_pci_get_bdf(pcidev); |
| |
| printf("videoboot: Booting PCI video card bus %d, function %d, device %d\n", |
| PCI_BUS(bdf), PCI_FUNC(bdf), PCI_DEV(bdf)); |
| #else |
| printf("videoboot: Booting PCI video card bus %d, function %d, device %d\n", |
| PCI_BUS(pcidev), PCI_FUNC(pcidev), PCI_DEV(pcidev)); |
| #endif |
| /*Initialise the x86 BIOS emulator*/ |
| if ((VGAInfo = malloc(sizeof(*VGAInfo))) == NULL) { |
| printf("videoboot: Out of memory!\n"); |
| return -ENOMEM; |
| } |
| memset(VGAInfo, 0, sizeof(*VGAInfo)); |
| BE_init(0, 65536, VGAInfo, 0); |
| *vga_infop = VGAInfo; |
| |
| return 0; |
| } |
| |
| void biosemu_set_interrupt_handler(int intnum, int (*int_func)(void)) |
| { |
| X86EMU_setupIntrFunc(intnum, (X86EMU_intrFuncs)int_func); |
| } |
| |
| #ifdef CONFIG_DM_PCI |
| int biosemu_run(struct udevice *pcidev, uchar *bios_rom, int bios_len, |
| BE_VGAInfo *vga_info, int clean_up, int vesa_mode, |
| struct vbe_mode_info *mode_info) |
| #else |
| int biosemu_run(pci_dev_t pcidev, uchar *bios_rom, int bios_len, |
| BE_VGAInfo *vga_info, int clean_up, int vesa_mode, |
| struct vbe_mode_info *mode_info) |
| #endif |
| { |
| /*Post all the display controller BIOS'es*/ |
| if (!PCI_postController(pcidev, bios_rom, bios_len, vga_info, |
| vesa_mode, mode_info)) |
| return -EINVAL; |
| |
| /* |
| * Cleanup and exit the emulator if requested. If the BIOS emulator |
| * is needed after booting the card, we will not call BE_exit and |
| * leave it enabled for further use (ie: VESA driver etc). |
| */ |
| if (clean_up) { |
| BE_exit(); |
| if (vga_info->BIOSImage && |
| (ulong)(vga_info->BIOSImage) != 0xc0000) |
| free(vga_info->BIOSImage); |
| free(vga_info); |
| vga_info = NULL; |
| } |
| |
| return 0; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| pcidev - PCI device info for the video card on the bus to boot |
| pVGAInfo - Place to return VGA info structure is requested |
| cleanUp - true to clean up on exit, false to leave emulator active |
| |
| REMARKS: |
| Boots the PCI/AGP video card on the bus using the Video ROM BIOS image |
| and the X86 BIOS emulator module. |
| ****************************************************************************/ |
| #ifdef CONFIG_DM_PCI |
| int BootVideoCardBIOS(struct udevice *pcidev, BE_VGAInfo **pVGAInfo, |
| int clean_up) |
| #else |
| int BootVideoCardBIOS(pci_dev_t pcidev, BE_VGAInfo **pVGAInfo, int clean_up) |
| #endif |
| { |
| BE_VGAInfo *VGAInfo; |
| int ret; |
| |
| ret = biosemu_setup(pcidev, &VGAInfo); |
| if (ret) |
| return false; |
| ret = biosemu_run(pcidev, NULL, 0, VGAInfo, clean_up, -1, NULL); |
| if (ret) |
| return false; |
| |
| /* Return VGA info pointer if the caller requested it*/ |
| if (pVGAInfo) |
| *pVGAInfo = VGAInfo; |
| |
| return true; |
| } |