]> git.sur5r.net Git - u-boot/blobdiff - drivers/pci/pci_rom.c
Merge branch 'master' of git://git.denx.de/u-boot-net
[u-boot] / drivers / pci / pci_rom.c
index 2cb81b66b7004565765a2f35e592f5cbd14974d2..57204c4f3f1ca098b19d60767320aa9542f081a1 100644 (file)
@@ -31,6 +31,7 @@
 #include <pci.h>
 #include <pci_rom.h>
 #include <vbe.h>
+#include <video.h>
 #include <video_fb.h>
 #include <linux/screen_info.h>
 
@@ -39,14 +40,9 @@ __weak bool board_should_run_oprom(struct udevice *dev)
        return true;
 }
 
-static bool should_load_oprom(struct udevice *dev)
+__weak bool board_should_load_oprom(struct udevice *dev)
 {
-       if (IS_ENABLED(CONFIG_ALWAYS_LOAD_OPROM))
-               return 1;
-       if (board_should_run_oprom(dev))
-               return 1;
-
-       return 0;
+       return true;
 }
 
 __weak uint32_t board_map_oprom_vendev(uint32_t vendev)
@@ -129,14 +125,26 @@ static int pci_rom_probe(struct udevice *dev, struct pci_rom_header **hdrp)
        return 0;
 }
 
-int pci_rom_load(struct pci_rom_header *rom_header,
-                struct pci_rom_header **ram_headerp)
+/**
+ * pci_rom_load() - Load a ROM image and return a pointer to it
+ *
+ * @rom_header:                Pointer to ROM image
+ * @ram_headerp:       Returns a pointer to the image in RAM
+ * @allocedp:          Returns true if @ram_headerp was allocated and needs
+ *                     to be freed
+ * @return 0 if OK, -ve on error. Note that @allocedp is set up regardless of
+ * the error state. Even if this function returns an error, it may have
+ * allocated memory.
+ */
+static int pci_rom_load(struct pci_rom_header *rom_header,
+                       struct pci_rom_header **ram_headerp, bool *allocedp)
 {
        struct pci_rom_data *rom_data;
        unsigned int rom_size;
        unsigned int image_size = 0;
        void *target;
 
+       *allocedp = false;
        do {
                /* Get next image, until we see an x86 version */
                rom_header = (struct pci_rom_header *)((void *)rom_header +
@@ -159,6 +167,7 @@ int pci_rom_load(struct pci_rom_header *rom_header,
        target = (void *)malloc(rom_size);
        if (!target)
                return -ENOMEM;
+       *allocedp = true;
 #endif
        if (target != rom_header) {
                ulong start = get_timer(0);
@@ -253,9 +262,9 @@ int dm_pci_run_vga_bios(struct udevice *dev, int (*int15_handler)(void),
                        int exec_method)
 {
        struct pci_child_platdata *pplat = dev_get_parent_platdata(dev);
-       struct pci_rom_header *rom, *ram;
+       struct pci_rom_header *rom = NULL, *ram = NULL;
        int vesa_mode = -1;
-       bool emulate;
+       bool emulate, alloced;
        int ret;
 
        /* Only execute VGA ROMs */
@@ -265,19 +274,21 @@ int dm_pci_run_vga_bios(struct udevice *dev, int (*int15_handler)(void),
                return -ENODEV;
        }
 
-       if (!should_load_oprom(dev))
+       if (!board_should_load_oprom(dev))
                return -ENXIO;
 
        ret = pci_rom_probe(dev, &rom);
        if (ret)
                return ret;
 
-       ret = pci_rom_load(rom, &ram);
+       ret = pci_rom_load(rom, &ram, &alloced);
        if (ret)
-               return ret;
+               goto err;
 
-       if (!board_should_run_oprom(dev))
-               return -ENXIO;
+       if (!board_should_run_oprom(dev)) {
+               ret = -ENXIO;
+               goto err;
+       }
 
 #if defined(CONFIG_FRAMEBUFFER_SET_VESA_MODE) && \
                defined(CONFIG_FRAMEBUFFER_VESA_MODE)
@@ -291,7 +302,8 @@ int dm_pci_run_vga_bios(struct udevice *dev, int (*int15_handler)(void),
 #else
                if (!(exec_method & PCI_ROM_ALLOW_FALLBACK)) {
                        printf("BIOS native execution is only available on x86\n");
-                       return -ENOSYS;
+                       ret = -ENOSYS;
+                       goto err;
                }
                emulate = true;
 #endif
@@ -301,7 +313,8 @@ int dm_pci_run_vga_bios(struct udevice *dev, int (*int15_handler)(void),
 #else
                if (!(exec_method & PCI_ROM_ALLOW_FALLBACK)) {
                        printf("BIOS emulation not available - see CONFIG_BIOSEMU\n");
-                       return -ENOSYS;
+                       ret = -ENOSYS;
+                       goto err;
                }
                emulate = false;
 #endif
@@ -311,17 +324,17 @@ int dm_pci_run_vga_bios(struct udevice *dev, int (*int15_handler)(void),
 #ifdef CONFIG_BIOSEMU
                BE_VGAInfo *info;
 
-               ret = biosemu_setup(dm_pci_get_bdf(dev), &info);
+               ret = biosemu_setup(dev, &info);
                if (ret)
-                       return ret;
+                       goto err;
                biosemu_set_interrupt_handler(0x15, int15_handler);
-               ret = biosemu_run(dm_pci_get_bdf(dev), (uchar *)ram, 1 << 16,
-                                 info, true, vesa_mode, &mode_info);
+               ret = biosemu_run(dev, (uchar *)ram, 1 << 16, info,
+                                 true, vesa_mode, &mode_info);
                if (ret)
-                       return ret;
+                       goto err;
 #endif
        } else {
-#ifdef CONFIG_X86
+#if defined(CONFIG_X86) && CONFIG_IS_ENABLED(X86_32BIT_INIT)
                bios_set_interrupt_handler(0x15, int15_handler);
 
                bios_run_on_x86(dev, (unsigned long)ram, vesa_mode,
@@ -329,6 +342,71 @@ int dm_pci_run_vga_bios(struct udevice *dev, int (*int15_handler)(void),
 #endif
        }
        debug("Final vesa mode %#x\n", mode_info.video_mode);
+       ret = 0;
+
+err:
+       if (alloced)
+               free(ram);
+       return ret;
+}
+
+#ifdef CONFIG_DM_VIDEO
+int vbe_setup_video_priv(struct vesa_mode_info *vesa,
+                        struct video_priv *uc_priv,
+                        struct video_uc_platdata *plat)
+{
+       if (!vesa->x_resolution)
+               return -ENXIO;
+       uc_priv->xsize = vesa->x_resolution;
+       uc_priv->ysize = vesa->y_resolution;
+       switch (vesa->bits_per_pixel) {
+       case 32:
+       case 24:
+               uc_priv->bpix = VIDEO_BPP32;
+               break;
+       case 16:
+               uc_priv->bpix = VIDEO_BPP16;
+               break;
+       default:
+               return -EPROTONOSUPPORT;
+       }
+       plat->base = vesa->phys_base_ptr;
+       plat->size = vesa->bytes_per_scanline * vesa->y_resolution;
 
        return 0;
 }
+
+int vbe_setup_video(struct udevice *dev, int (*int15_handler)(void))
+{
+       struct video_uc_platdata *plat = dev_get_uclass_platdata(dev);
+       struct video_priv *uc_priv = dev_get_uclass_priv(dev);
+       int ret;
+
+       printf("Video: ");
+
+       /* If we are running from EFI or coreboot, this can't work */
+       if (!ll_boot_init()) {
+               printf("Not available (previous bootloader prevents it)\n");
+               return -EPERM;
+       }
+       bootstage_start(BOOTSTAGE_ID_ACCUM_LCD, "vesa display");
+       ret = dm_pci_run_vga_bios(dev, int15_handler, PCI_ROM_USE_NATIVE |
+                                       PCI_ROM_ALLOW_FALLBACK);
+       bootstage_accum(BOOTSTAGE_ID_ACCUM_LCD);
+       if (ret) {
+               debug("failed to run video BIOS: %d\n", ret);
+               return ret;
+       }
+
+       ret = vbe_setup_video_priv(&mode_info.vesa, uc_priv, plat);
+       if (ret) {
+               debug("No video mode configured\n");
+               return ret;
+       }
+
+       printf("%dx%dx%d\n", uc_priv->xsize, uc_priv->ysize,
+              mode_info.vesa.bits_per_pixel);
+
+       return 0;
+}
+#endif