123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197 |
- #include <linux/kernel.h>
- #include <linux/export.h>
- #include <linux/pci.h>
- #include <linux/slab.h>
- #include "pci.h"
- int pci_enable_rom(struct pci_dev *pdev)
- {
- struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];
- struct pci_bus_region region;
- u32 rom_addr;
- if (!res->flags)
- return -1;
-
- if (res->flags & IORESOURCE_ROM_SHADOW)
- return 0;
-
- pcibios_resource_to_bus(pdev->bus, ®ion, res);
- pci_read_config_dword(pdev, pdev->rom_base_reg, &rom_addr);
- rom_addr &= ~PCI_ROM_ADDRESS_MASK;
- rom_addr |= region.start | PCI_ROM_ADDRESS_ENABLE;
- pci_write_config_dword(pdev, pdev->rom_base_reg, rom_addr);
- return 0;
- }
- EXPORT_SYMBOL_GPL(pci_enable_rom);
- void pci_disable_rom(struct pci_dev *pdev)
- {
- struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];
- u32 rom_addr;
- if (res->flags & IORESOURCE_ROM_SHADOW)
- return;
- pci_read_config_dword(pdev, pdev->rom_base_reg, &rom_addr);
- rom_addr &= ~PCI_ROM_ADDRESS_ENABLE;
- pci_write_config_dword(pdev, pdev->rom_base_reg, rom_addr);
- }
- EXPORT_SYMBOL_GPL(pci_disable_rom);
- static size_t pci_get_rom_size(struct pci_dev *pdev, void __iomem *rom,
- size_t size)
- {
- void __iomem *image;
- int last_image;
- unsigned int length;
- image = rom;
- do {
- void __iomem *pds;
-
- if (readw(image) != 0xAA55) {
- pci_info(pdev, "Invalid PCI ROM header signature: expecting 0xaa55, got %#06x\n",
- readw(image));
- break;
- }
-
- pds = image + readw(image + 24);
- if (readl(pds) != 0x52494350) {
- pci_info(pdev, "Invalid PCI ROM data signature: expecting 0x52494350, got %#010x\n",
- readl(pds));
- break;
- }
- last_image = readb(pds + 21) & 0x80;
- length = readw(pds + 16);
- image += length * 512;
-
- if (image >= rom + size)
- break;
- if (!last_image) {
- if (readw(image) != 0xAA55) {
- pci_info(pdev, "No more image in the PCI ROM\n");
- break;
- }
- }
- } while (length && !last_image);
-
-
- return min((size_t)(image - rom), size);
- }
- void __iomem *pci_map_rom(struct pci_dev *pdev, size_t *size)
- {
- struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];
- loff_t start;
- void __iomem *rom;
-
- if (res->parent == NULL && pci_assign_resource(pdev, PCI_ROM_RESOURCE))
- return NULL;
- start = pci_resource_start(pdev, PCI_ROM_RESOURCE);
- *size = pci_resource_len(pdev, PCI_ROM_RESOURCE);
- if (*size == 0)
- return NULL;
-
- if (pci_enable_rom(pdev))
- return NULL;
- rom = ioremap(start, *size);
- if (!rom)
- goto err_ioremap;
-
- *size = pci_get_rom_size(pdev, rom, *size);
- if (!*size)
- goto invalid_rom;
- return rom;
- invalid_rom:
- iounmap(rom);
- err_ioremap:
-
- if (!(res->flags & IORESOURCE_ROM_ENABLE))
- pci_disable_rom(pdev);
- return NULL;
- }
- EXPORT_SYMBOL(pci_map_rom);
- void pci_unmap_rom(struct pci_dev *pdev, void __iomem *rom)
- {
- struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];
- iounmap(rom);
-
- if (!(res->flags & IORESOURCE_ROM_ENABLE))
- pci_disable_rom(pdev);
- }
- EXPORT_SYMBOL(pci_unmap_rom);
|