18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * esb2rom.c 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Normal mappings of flash chips in physical memory 68c2ecf20Sopenharmony_ci * through the Intel ESB2 Southbridge. 78c2ecf20Sopenharmony_ci * 88c2ecf20Sopenharmony_ci * This was derived from ichxrom.c in May 2006 by 98c2ecf20Sopenharmony_ci * Lew Glendenning <lglendenning@lnxi.com> 108c2ecf20Sopenharmony_ci * 118c2ecf20Sopenharmony_ci * Eric Biederman, of course, was a major help in this effort. 128c2ecf20Sopenharmony_ci */ 138c2ecf20Sopenharmony_ci 148c2ecf20Sopenharmony_ci#include <linux/module.h> 158c2ecf20Sopenharmony_ci#include <linux/types.h> 168c2ecf20Sopenharmony_ci#include <linux/kernel.h> 178c2ecf20Sopenharmony_ci#include <linux/init.h> 188c2ecf20Sopenharmony_ci#include <linux/slab.h> 198c2ecf20Sopenharmony_ci#include <asm/io.h> 208c2ecf20Sopenharmony_ci#include <linux/mtd/mtd.h> 218c2ecf20Sopenharmony_ci#include <linux/mtd/map.h> 228c2ecf20Sopenharmony_ci#include <linux/mtd/cfi.h> 238c2ecf20Sopenharmony_ci#include <linux/mtd/flashchip.h> 248c2ecf20Sopenharmony_ci#include <linux/pci.h> 258c2ecf20Sopenharmony_ci#include <linux/pci_ids.h> 268c2ecf20Sopenharmony_ci#include <linux/list.h> 278c2ecf20Sopenharmony_ci 288c2ecf20Sopenharmony_ci#define MOD_NAME KBUILD_BASENAME 298c2ecf20Sopenharmony_ci 308c2ecf20Sopenharmony_ci#define ADDRESS_NAME_LEN 18 318c2ecf20Sopenharmony_ci 328c2ecf20Sopenharmony_ci#define ROM_PROBE_STEP_SIZE (64*1024) /* 64KiB */ 338c2ecf20Sopenharmony_ci 348c2ecf20Sopenharmony_ci#define BIOS_CNTL 0xDC 358c2ecf20Sopenharmony_ci#define BIOS_LOCK_ENABLE 0x02 368c2ecf20Sopenharmony_ci#define BIOS_WRITE_ENABLE 0x01 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_ci/* This became a 16-bit register, and EN2 has disappeared */ 398c2ecf20Sopenharmony_ci#define FWH_DEC_EN1 0xD8 408c2ecf20Sopenharmony_ci#define FWH_F8_EN 0x8000 418c2ecf20Sopenharmony_ci#define FWH_F0_EN 0x4000 428c2ecf20Sopenharmony_ci#define FWH_E8_EN 0x2000 438c2ecf20Sopenharmony_ci#define FWH_E0_EN 0x1000 448c2ecf20Sopenharmony_ci#define FWH_D8_EN 0x0800 458c2ecf20Sopenharmony_ci#define FWH_D0_EN 0x0400 468c2ecf20Sopenharmony_ci#define FWH_C8_EN 0x0200 478c2ecf20Sopenharmony_ci#define FWH_C0_EN 0x0100 488c2ecf20Sopenharmony_ci#define FWH_LEGACY_F_EN 0x0080 498c2ecf20Sopenharmony_ci#define FWH_LEGACY_E_EN 0x0040 508c2ecf20Sopenharmony_ci/* reserved 0x0020 and 0x0010 */ 518c2ecf20Sopenharmony_ci#define FWH_70_EN 0x0008 528c2ecf20Sopenharmony_ci#define FWH_60_EN 0x0004 538c2ecf20Sopenharmony_ci#define FWH_50_EN 0x0002 548c2ecf20Sopenharmony_ci#define FWH_40_EN 0x0001 558c2ecf20Sopenharmony_ci 568c2ecf20Sopenharmony_ci/* these are 32-bit values */ 578c2ecf20Sopenharmony_ci#define FWH_SEL1 0xD0 588c2ecf20Sopenharmony_ci#define FWH_SEL2 0xD4 598c2ecf20Sopenharmony_ci 608c2ecf20Sopenharmony_ci#define FWH_8MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN | FWH_E0_EN | \ 618c2ecf20Sopenharmony_ci FWH_D8_EN | FWH_D0_EN | FWH_C8_EN | FWH_C0_EN | \ 628c2ecf20Sopenharmony_ci FWH_70_EN | FWH_60_EN | FWH_50_EN | FWH_40_EN) 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_ci#define FWH_7MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN | FWH_E0_EN | \ 658c2ecf20Sopenharmony_ci FWH_D8_EN | FWH_D0_EN | FWH_C8_EN | FWH_C0_EN | \ 668c2ecf20Sopenharmony_ci FWH_70_EN | FWH_60_EN | FWH_50_EN) 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci#define FWH_6MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN | FWH_E0_EN | \ 698c2ecf20Sopenharmony_ci FWH_D8_EN | FWH_D0_EN | FWH_C8_EN | FWH_C0_EN | \ 708c2ecf20Sopenharmony_ci FWH_70_EN | FWH_60_EN) 718c2ecf20Sopenharmony_ci 728c2ecf20Sopenharmony_ci#define FWH_5MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN | FWH_E0_EN | \ 738c2ecf20Sopenharmony_ci FWH_D8_EN | FWH_D0_EN | FWH_C8_EN | FWH_C0_EN | \ 748c2ecf20Sopenharmony_ci FWH_70_EN) 758c2ecf20Sopenharmony_ci 768c2ecf20Sopenharmony_ci#define FWH_4MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN | FWH_E0_EN | \ 778c2ecf20Sopenharmony_ci FWH_D8_EN | FWH_D0_EN | FWH_C8_EN | FWH_C0_EN) 788c2ecf20Sopenharmony_ci 798c2ecf20Sopenharmony_ci#define FWH_3_5MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN | FWH_E0_EN | \ 808c2ecf20Sopenharmony_ci FWH_D8_EN | FWH_D0_EN | FWH_C8_EN) 818c2ecf20Sopenharmony_ci 828c2ecf20Sopenharmony_ci#define FWH_3MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN | FWH_E0_EN | \ 838c2ecf20Sopenharmony_ci FWH_D8_EN | FWH_D0_EN) 848c2ecf20Sopenharmony_ci 858c2ecf20Sopenharmony_ci#define FWH_2_5MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN | FWH_E0_EN | \ 868c2ecf20Sopenharmony_ci FWH_D8_EN) 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci#define FWH_2MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN | FWH_E0_EN) 898c2ecf20Sopenharmony_ci 908c2ecf20Sopenharmony_ci#define FWH_1_5MiB (FWH_F8_EN | FWH_F0_EN | FWH_E8_EN) 918c2ecf20Sopenharmony_ci 928c2ecf20Sopenharmony_ci#define FWH_1MiB (FWH_F8_EN | FWH_F0_EN) 938c2ecf20Sopenharmony_ci 948c2ecf20Sopenharmony_ci#define FWH_0_5MiB (FWH_F8_EN) 958c2ecf20Sopenharmony_ci 968c2ecf20Sopenharmony_ci 978c2ecf20Sopenharmony_cistruct esb2rom_window { 988c2ecf20Sopenharmony_ci void __iomem* virt; 998c2ecf20Sopenharmony_ci unsigned long phys; 1008c2ecf20Sopenharmony_ci unsigned long size; 1018c2ecf20Sopenharmony_ci struct list_head maps; 1028c2ecf20Sopenharmony_ci struct resource rsrc; 1038c2ecf20Sopenharmony_ci struct pci_dev *pdev; 1048c2ecf20Sopenharmony_ci}; 1058c2ecf20Sopenharmony_ci 1068c2ecf20Sopenharmony_cistruct esb2rom_map_info { 1078c2ecf20Sopenharmony_ci struct list_head list; 1088c2ecf20Sopenharmony_ci struct map_info map; 1098c2ecf20Sopenharmony_ci struct mtd_info *mtd; 1108c2ecf20Sopenharmony_ci struct resource rsrc; 1118c2ecf20Sopenharmony_ci char map_name[sizeof(MOD_NAME) + 2 + ADDRESS_NAME_LEN]; 1128c2ecf20Sopenharmony_ci}; 1138c2ecf20Sopenharmony_ci 1148c2ecf20Sopenharmony_cistatic struct esb2rom_window esb2rom_window = { 1158c2ecf20Sopenharmony_ci .maps = LIST_HEAD_INIT(esb2rom_window.maps), 1168c2ecf20Sopenharmony_ci}; 1178c2ecf20Sopenharmony_ci 1188c2ecf20Sopenharmony_cistatic void esb2rom_cleanup(struct esb2rom_window *window) 1198c2ecf20Sopenharmony_ci{ 1208c2ecf20Sopenharmony_ci struct esb2rom_map_info *map, *scratch; 1218c2ecf20Sopenharmony_ci u8 byte; 1228c2ecf20Sopenharmony_ci 1238c2ecf20Sopenharmony_ci /* Disable writes through the rom window */ 1248c2ecf20Sopenharmony_ci pci_read_config_byte(window->pdev, BIOS_CNTL, &byte); 1258c2ecf20Sopenharmony_ci pci_write_config_byte(window->pdev, BIOS_CNTL, 1268c2ecf20Sopenharmony_ci byte & ~BIOS_WRITE_ENABLE); 1278c2ecf20Sopenharmony_ci 1288c2ecf20Sopenharmony_ci /* Free all of the mtd devices */ 1298c2ecf20Sopenharmony_ci list_for_each_entry_safe(map, scratch, &window->maps, list) { 1308c2ecf20Sopenharmony_ci if (map->rsrc.parent) 1318c2ecf20Sopenharmony_ci release_resource(&map->rsrc); 1328c2ecf20Sopenharmony_ci mtd_device_unregister(map->mtd); 1338c2ecf20Sopenharmony_ci map_destroy(map->mtd); 1348c2ecf20Sopenharmony_ci list_del(&map->list); 1358c2ecf20Sopenharmony_ci kfree(map); 1368c2ecf20Sopenharmony_ci } 1378c2ecf20Sopenharmony_ci if (window->rsrc.parent) 1388c2ecf20Sopenharmony_ci release_resource(&window->rsrc); 1398c2ecf20Sopenharmony_ci if (window->virt) { 1408c2ecf20Sopenharmony_ci iounmap(window->virt); 1418c2ecf20Sopenharmony_ci window->virt = NULL; 1428c2ecf20Sopenharmony_ci window->phys = 0; 1438c2ecf20Sopenharmony_ci window->size = 0; 1448c2ecf20Sopenharmony_ci } 1458c2ecf20Sopenharmony_ci pci_dev_put(window->pdev); 1468c2ecf20Sopenharmony_ci} 1478c2ecf20Sopenharmony_ci 1488c2ecf20Sopenharmony_cistatic int __init esb2rom_init_one(struct pci_dev *pdev, 1498c2ecf20Sopenharmony_ci const struct pci_device_id *ent) 1508c2ecf20Sopenharmony_ci{ 1518c2ecf20Sopenharmony_ci static char *rom_probe_types[] = { "cfi_probe", "jedec_probe", NULL }; 1528c2ecf20Sopenharmony_ci struct esb2rom_window *window = &esb2rom_window; 1538c2ecf20Sopenharmony_ci struct esb2rom_map_info *map = NULL; 1548c2ecf20Sopenharmony_ci unsigned long map_top; 1558c2ecf20Sopenharmony_ci u8 byte; 1568c2ecf20Sopenharmony_ci u16 word; 1578c2ecf20Sopenharmony_ci 1588c2ecf20Sopenharmony_ci /* For now I just handle the ecb2 and I assume there 1598c2ecf20Sopenharmony_ci * are not a lot of resources up at the top of the address 1608c2ecf20Sopenharmony_ci * space. It is possible to handle other devices in the 1618c2ecf20Sopenharmony_ci * top 16MiB but it is very painful. Also since 1628c2ecf20Sopenharmony_ci * you can only really attach a FWH to an ICHX there 1638c2ecf20Sopenharmony_ci * a number of simplifications you can make. 1648c2ecf20Sopenharmony_ci * 1658c2ecf20Sopenharmony_ci * Also you can page firmware hubs if an 8MiB window isn't enough 1668c2ecf20Sopenharmony_ci * but don't currently handle that case either. 1678c2ecf20Sopenharmony_ci */ 1688c2ecf20Sopenharmony_ci window->pdev = pci_dev_get(pdev); 1698c2ecf20Sopenharmony_ci 1708c2ecf20Sopenharmony_ci /* RLG: experiment 2. Force the window registers to the widest values */ 1718c2ecf20Sopenharmony_ci 1728c2ecf20Sopenharmony_ci/* 1738c2ecf20Sopenharmony_ci pci_read_config_word(pdev, FWH_DEC_EN1, &word); 1748c2ecf20Sopenharmony_ci printk(KERN_DEBUG "Original FWH_DEC_EN1 : %x\n", word); 1758c2ecf20Sopenharmony_ci pci_write_config_byte(pdev, FWH_DEC_EN1, 0xff); 1768c2ecf20Sopenharmony_ci pci_read_config_byte(pdev, FWH_DEC_EN1, &byte); 1778c2ecf20Sopenharmony_ci printk(KERN_DEBUG "New FWH_DEC_EN1 : %x\n", byte); 1788c2ecf20Sopenharmony_ci 1798c2ecf20Sopenharmony_ci pci_read_config_byte(pdev, FWH_DEC_EN2, &byte); 1808c2ecf20Sopenharmony_ci printk(KERN_DEBUG "Original FWH_DEC_EN2 : %x\n", byte); 1818c2ecf20Sopenharmony_ci pci_write_config_byte(pdev, FWH_DEC_EN2, 0x0f); 1828c2ecf20Sopenharmony_ci pci_read_config_byte(pdev, FWH_DEC_EN2, &byte); 1838c2ecf20Sopenharmony_ci printk(KERN_DEBUG "New FWH_DEC_EN2 : %x\n", byte); 1848c2ecf20Sopenharmony_ci*/ 1858c2ecf20Sopenharmony_ci 1868c2ecf20Sopenharmony_ci /* Find a region continuous to the end of the ROM window */ 1878c2ecf20Sopenharmony_ci window->phys = 0; 1888c2ecf20Sopenharmony_ci pci_read_config_word(pdev, FWH_DEC_EN1, &word); 1898c2ecf20Sopenharmony_ci printk(KERN_DEBUG "pci_read_config_word : %x\n", word); 1908c2ecf20Sopenharmony_ci 1918c2ecf20Sopenharmony_ci if ((word & FWH_8MiB) == FWH_8MiB) 1928c2ecf20Sopenharmony_ci window->phys = 0xff400000; 1938c2ecf20Sopenharmony_ci else if ((word & FWH_7MiB) == FWH_7MiB) 1948c2ecf20Sopenharmony_ci window->phys = 0xff500000; 1958c2ecf20Sopenharmony_ci else if ((word & FWH_6MiB) == FWH_6MiB) 1968c2ecf20Sopenharmony_ci window->phys = 0xff600000; 1978c2ecf20Sopenharmony_ci else if ((word & FWH_5MiB) == FWH_5MiB) 1988c2ecf20Sopenharmony_ci window->phys = 0xFF700000; 1998c2ecf20Sopenharmony_ci else if ((word & FWH_4MiB) == FWH_4MiB) 2008c2ecf20Sopenharmony_ci window->phys = 0xffc00000; 2018c2ecf20Sopenharmony_ci else if ((word & FWH_3_5MiB) == FWH_3_5MiB) 2028c2ecf20Sopenharmony_ci window->phys = 0xffc80000; 2038c2ecf20Sopenharmony_ci else if ((word & FWH_3MiB) == FWH_3MiB) 2048c2ecf20Sopenharmony_ci window->phys = 0xffd00000; 2058c2ecf20Sopenharmony_ci else if ((word & FWH_2_5MiB) == FWH_2_5MiB) 2068c2ecf20Sopenharmony_ci window->phys = 0xffd80000; 2078c2ecf20Sopenharmony_ci else if ((word & FWH_2MiB) == FWH_2MiB) 2088c2ecf20Sopenharmony_ci window->phys = 0xffe00000; 2098c2ecf20Sopenharmony_ci else if ((word & FWH_1_5MiB) == FWH_1_5MiB) 2108c2ecf20Sopenharmony_ci window->phys = 0xffe80000; 2118c2ecf20Sopenharmony_ci else if ((word & FWH_1MiB) == FWH_1MiB) 2128c2ecf20Sopenharmony_ci window->phys = 0xfff00000; 2138c2ecf20Sopenharmony_ci else if ((word & FWH_0_5MiB) == FWH_0_5MiB) 2148c2ecf20Sopenharmony_ci window->phys = 0xfff80000; 2158c2ecf20Sopenharmony_ci 2168c2ecf20Sopenharmony_ci if (window->phys == 0) { 2178c2ecf20Sopenharmony_ci printk(KERN_ERR MOD_NAME ": Rom window is closed\n"); 2188c2ecf20Sopenharmony_ci goto out; 2198c2ecf20Sopenharmony_ci } 2208c2ecf20Sopenharmony_ci 2218c2ecf20Sopenharmony_ci /* reserved 0x0020 and 0x0010 */ 2228c2ecf20Sopenharmony_ci window->phys -= 0x400000UL; 2238c2ecf20Sopenharmony_ci window->size = (0xffffffffUL - window->phys) + 1UL; 2248c2ecf20Sopenharmony_ci 2258c2ecf20Sopenharmony_ci /* Enable writes through the rom window */ 2268c2ecf20Sopenharmony_ci pci_read_config_byte(pdev, BIOS_CNTL, &byte); 2278c2ecf20Sopenharmony_ci if (!(byte & BIOS_WRITE_ENABLE) && (byte & (BIOS_LOCK_ENABLE))) { 2288c2ecf20Sopenharmony_ci /* The BIOS will generate an error if I enable 2298c2ecf20Sopenharmony_ci * this device, so don't even try. 2308c2ecf20Sopenharmony_ci */ 2318c2ecf20Sopenharmony_ci printk(KERN_ERR MOD_NAME ": firmware access control, I can't enable writes\n"); 2328c2ecf20Sopenharmony_ci goto out; 2338c2ecf20Sopenharmony_ci } 2348c2ecf20Sopenharmony_ci pci_write_config_byte(pdev, BIOS_CNTL, byte | BIOS_WRITE_ENABLE); 2358c2ecf20Sopenharmony_ci 2368c2ecf20Sopenharmony_ci /* 2378c2ecf20Sopenharmony_ci * Try to reserve the window mem region. If this fails then 2388c2ecf20Sopenharmony_ci * it is likely due to the window being "reserved" by the BIOS. 2398c2ecf20Sopenharmony_ci */ 2408c2ecf20Sopenharmony_ci window->rsrc.name = MOD_NAME; 2418c2ecf20Sopenharmony_ci window->rsrc.start = window->phys; 2428c2ecf20Sopenharmony_ci window->rsrc.end = window->phys + window->size - 1; 2438c2ecf20Sopenharmony_ci window->rsrc.flags = IORESOURCE_MEM | IORESOURCE_BUSY; 2448c2ecf20Sopenharmony_ci if (request_resource(&iomem_resource, &window->rsrc)) { 2458c2ecf20Sopenharmony_ci window->rsrc.parent = NULL; 2468c2ecf20Sopenharmony_ci printk(KERN_DEBUG MOD_NAME ": " 2478c2ecf20Sopenharmony_ci "%s(): Unable to register resource %pR - kernel bug?\n", 2488c2ecf20Sopenharmony_ci __func__, &window->rsrc); 2498c2ecf20Sopenharmony_ci } 2508c2ecf20Sopenharmony_ci 2518c2ecf20Sopenharmony_ci /* Map the firmware hub into my address space. */ 2528c2ecf20Sopenharmony_ci window->virt = ioremap(window->phys, window->size); 2538c2ecf20Sopenharmony_ci if (!window->virt) { 2548c2ecf20Sopenharmony_ci printk(KERN_ERR MOD_NAME ": ioremap(%08lx, %08lx) failed\n", 2558c2ecf20Sopenharmony_ci window->phys, window->size); 2568c2ecf20Sopenharmony_ci goto out; 2578c2ecf20Sopenharmony_ci } 2588c2ecf20Sopenharmony_ci 2598c2ecf20Sopenharmony_ci /* Get the first address to look for an rom chip at */ 2608c2ecf20Sopenharmony_ci map_top = window->phys; 2618c2ecf20Sopenharmony_ci if ((window->phys & 0x3fffff) != 0) { 2628c2ecf20Sopenharmony_ci /* if not aligned on 4MiB, look 4MiB lower in address space */ 2638c2ecf20Sopenharmony_ci map_top = window->phys + 0x400000; 2648c2ecf20Sopenharmony_ci } 2658c2ecf20Sopenharmony_ci#if 1 2668c2ecf20Sopenharmony_ci /* The probe sequence run over the firmware hub lock 2678c2ecf20Sopenharmony_ci * registers sets them to 0x7 (no access). 2688c2ecf20Sopenharmony_ci * (Insane hardware design, but most copied Intel's.) 2698c2ecf20Sopenharmony_ci * ==> Probe at most the last 4M of the address space. 2708c2ecf20Sopenharmony_ci */ 2718c2ecf20Sopenharmony_ci if (map_top < 0xffc00000) 2728c2ecf20Sopenharmony_ci map_top = 0xffc00000; 2738c2ecf20Sopenharmony_ci#endif 2748c2ecf20Sopenharmony_ci /* Loop through and look for rom chips */ 2758c2ecf20Sopenharmony_ci while ((map_top - 1) < 0xffffffffUL) { 2768c2ecf20Sopenharmony_ci struct cfi_private *cfi; 2778c2ecf20Sopenharmony_ci unsigned long offset; 2788c2ecf20Sopenharmony_ci int i; 2798c2ecf20Sopenharmony_ci 2808c2ecf20Sopenharmony_ci if (!map) 2818c2ecf20Sopenharmony_ci map = kmalloc(sizeof(*map), GFP_KERNEL); 2828c2ecf20Sopenharmony_ci if (!map) { 2838c2ecf20Sopenharmony_ci printk(KERN_ERR MOD_NAME ": kmalloc failed"); 2848c2ecf20Sopenharmony_ci goto out; 2858c2ecf20Sopenharmony_ci } 2868c2ecf20Sopenharmony_ci memset(map, 0, sizeof(*map)); 2878c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&map->list); 2888c2ecf20Sopenharmony_ci map->map.name = map->map_name; 2898c2ecf20Sopenharmony_ci map->map.phys = map_top; 2908c2ecf20Sopenharmony_ci offset = map_top - window->phys; 2918c2ecf20Sopenharmony_ci map->map.virt = (void __iomem *) 2928c2ecf20Sopenharmony_ci (((unsigned long)(window->virt)) + offset); 2938c2ecf20Sopenharmony_ci map->map.size = 0xffffffffUL - map_top + 1UL; 2948c2ecf20Sopenharmony_ci /* Set the name of the map to the address I am trying */ 2958c2ecf20Sopenharmony_ci sprintf(map->map_name, "%s @%08Lx", 2968c2ecf20Sopenharmony_ci MOD_NAME, (unsigned long long)map->map.phys); 2978c2ecf20Sopenharmony_ci 2988c2ecf20Sopenharmony_ci /* Firmware hubs only use vpp when being programmed 2998c2ecf20Sopenharmony_ci * in a factory setting. So in-place programming 3008c2ecf20Sopenharmony_ci * needs to use a different method. 3018c2ecf20Sopenharmony_ci */ 3028c2ecf20Sopenharmony_ci for(map->map.bankwidth = 32; map->map.bankwidth; 3038c2ecf20Sopenharmony_ci map->map.bankwidth >>= 1) { 3048c2ecf20Sopenharmony_ci char **probe_type; 3058c2ecf20Sopenharmony_ci /* Skip bankwidths that are not supported */ 3068c2ecf20Sopenharmony_ci if (!map_bankwidth_supported(map->map.bankwidth)) 3078c2ecf20Sopenharmony_ci continue; 3088c2ecf20Sopenharmony_ci 3098c2ecf20Sopenharmony_ci /* Setup the map methods */ 3108c2ecf20Sopenharmony_ci simple_map_init(&map->map); 3118c2ecf20Sopenharmony_ci 3128c2ecf20Sopenharmony_ci /* Try all of the probe methods */ 3138c2ecf20Sopenharmony_ci probe_type = rom_probe_types; 3148c2ecf20Sopenharmony_ci for(; *probe_type; probe_type++) { 3158c2ecf20Sopenharmony_ci map->mtd = do_map_probe(*probe_type, &map->map); 3168c2ecf20Sopenharmony_ci if (map->mtd) 3178c2ecf20Sopenharmony_ci goto found; 3188c2ecf20Sopenharmony_ci } 3198c2ecf20Sopenharmony_ci } 3208c2ecf20Sopenharmony_ci map_top += ROM_PROBE_STEP_SIZE; 3218c2ecf20Sopenharmony_ci continue; 3228c2ecf20Sopenharmony_ci found: 3238c2ecf20Sopenharmony_ci /* Trim the size if we are larger than the map */ 3248c2ecf20Sopenharmony_ci if (map->mtd->size > map->map.size) { 3258c2ecf20Sopenharmony_ci printk(KERN_WARNING MOD_NAME 3268c2ecf20Sopenharmony_ci " rom(%llu) larger than window(%lu). fixing...\n", 3278c2ecf20Sopenharmony_ci (unsigned long long)map->mtd->size, map->map.size); 3288c2ecf20Sopenharmony_ci map->mtd->size = map->map.size; 3298c2ecf20Sopenharmony_ci } 3308c2ecf20Sopenharmony_ci if (window->rsrc.parent) { 3318c2ecf20Sopenharmony_ci /* 3328c2ecf20Sopenharmony_ci * Registering the MTD device in iomem may not be possible 3338c2ecf20Sopenharmony_ci * if there is a BIOS "reserved" and BUSY range. If this 3348c2ecf20Sopenharmony_ci * fails then continue anyway. 3358c2ecf20Sopenharmony_ci */ 3368c2ecf20Sopenharmony_ci map->rsrc.name = map->map_name; 3378c2ecf20Sopenharmony_ci map->rsrc.start = map->map.phys; 3388c2ecf20Sopenharmony_ci map->rsrc.end = map->map.phys + map->mtd->size - 1; 3398c2ecf20Sopenharmony_ci map->rsrc.flags = IORESOURCE_MEM | IORESOURCE_BUSY; 3408c2ecf20Sopenharmony_ci if (request_resource(&window->rsrc, &map->rsrc)) { 3418c2ecf20Sopenharmony_ci printk(KERN_ERR MOD_NAME 3428c2ecf20Sopenharmony_ci ": cannot reserve MTD resource\n"); 3438c2ecf20Sopenharmony_ci map->rsrc.parent = NULL; 3448c2ecf20Sopenharmony_ci } 3458c2ecf20Sopenharmony_ci } 3468c2ecf20Sopenharmony_ci 3478c2ecf20Sopenharmony_ci /* Make the whole region visible in the map */ 3488c2ecf20Sopenharmony_ci map->map.virt = window->virt; 3498c2ecf20Sopenharmony_ci map->map.phys = window->phys; 3508c2ecf20Sopenharmony_ci cfi = map->map.fldrv_priv; 3518c2ecf20Sopenharmony_ci for(i = 0; i < cfi->numchips; i++) 3528c2ecf20Sopenharmony_ci cfi->chips[i].start += offset; 3538c2ecf20Sopenharmony_ci 3548c2ecf20Sopenharmony_ci /* Now that the mtd devices is complete claim and export it */ 3558c2ecf20Sopenharmony_ci map->mtd->owner = THIS_MODULE; 3568c2ecf20Sopenharmony_ci if (mtd_device_register(map->mtd, NULL, 0)) { 3578c2ecf20Sopenharmony_ci map_destroy(map->mtd); 3588c2ecf20Sopenharmony_ci map->mtd = NULL; 3598c2ecf20Sopenharmony_ci goto out; 3608c2ecf20Sopenharmony_ci } 3618c2ecf20Sopenharmony_ci 3628c2ecf20Sopenharmony_ci /* Calculate the new value of map_top */ 3638c2ecf20Sopenharmony_ci map_top += map->mtd->size; 3648c2ecf20Sopenharmony_ci 3658c2ecf20Sopenharmony_ci /* File away the map structure */ 3668c2ecf20Sopenharmony_ci list_add(&map->list, &window->maps); 3678c2ecf20Sopenharmony_ci map = NULL; 3688c2ecf20Sopenharmony_ci } 3698c2ecf20Sopenharmony_ci 3708c2ecf20Sopenharmony_ci out: 3718c2ecf20Sopenharmony_ci /* Free any left over map structures */ 3728c2ecf20Sopenharmony_ci kfree(map); 3738c2ecf20Sopenharmony_ci 3748c2ecf20Sopenharmony_ci /* See if I have any map structures */ 3758c2ecf20Sopenharmony_ci if (list_empty(&window->maps)) { 3768c2ecf20Sopenharmony_ci esb2rom_cleanup(window); 3778c2ecf20Sopenharmony_ci return -ENODEV; 3788c2ecf20Sopenharmony_ci } 3798c2ecf20Sopenharmony_ci return 0; 3808c2ecf20Sopenharmony_ci} 3818c2ecf20Sopenharmony_ci 3828c2ecf20Sopenharmony_cistatic void esb2rom_remove_one(struct pci_dev *pdev) 3838c2ecf20Sopenharmony_ci{ 3848c2ecf20Sopenharmony_ci struct esb2rom_window *window = &esb2rom_window; 3858c2ecf20Sopenharmony_ci esb2rom_cleanup(window); 3868c2ecf20Sopenharmony_ci} 3878c2ecf20Sopenharmony_ci 3888c2ecf20Sopenharmony_cistatic const struct pci_device_id esb2rom_pci_tbl[] = { 3898c2ecf20Sopenharmony_ci { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801BA_0, 3908c2ecf20Sopenharmony_ci PCI_ANY_ID, PCI_ANY_ID, }, 3918c2ecf20Sopenharmony_ci { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801CA_0, 3928c2ecf20Sopenharmony_ci PCI_ANY_ID, PCI_ANY_ID, }, 3938c2ecf20Sopenharmony_ci { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801DB_0, 3948c2ecf20Sopenharmony_ci PCI_ANY_ID, PCI_ANY_ID, }, 3958c2ecf20Sopenharmony_ci { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82801EB_0, 3968c2ecf20Sopenharmony_ci PCI_ANY_ID, PCI_ANY_ID, }, 3978c2ecf20Sopenharmony_ci { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ESB_1, 3988c2ecf20Sopenharmony_ci PCI_ANY_ID, PCI_ANY_ID, }, 3998c2ecf20Sopenharmony_ci { PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ESB2_0, 4008c2ecf20Sopenharmony_ci PCI_ANY_ID, PCI_ANY_ID, }, 4018c2ecf20Sopenharmony_ci { 0, }, 4028c2ecf20Sopenharmony_ci}; 4038c2ecf20Sopenharmony_ci 4048c2ecf20Sopenharmony_ci#if 0 4058c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(pci, esb2rom_pci_tbl); 4068c2ecf20Sopenharmony_ci 4078c2ecf20Sopenharmony_cistatic struct pci_driver esb2rom_driver = { 4088c2ecf20Sopenharmony_ci .name = MOD_NAME, 4098c2ecf20Sopenharmony_ci .id_table = esb2rom_pci_tbl, 4108c2ecf20Sopenharmony_ci .probe = esb2rom_init_one, 4118c2ecf20Sopenharmony_ci .remove = esb2rom_remove_one, 4128c2ecf20Sopenharmony_ci}; 4138c2ecf20Sopenharmony_ci#endif 4148c2ecf20Sopenharmony_ci 4158c2ecf20Sopenharmony_cistatic int __init init_esb2rom(void) 4168c2ecf20Sopenharmony_ci{ 4178c2ecf20Sopenharmony_ci struct pci_dev *pdev; 4188c2ecf20Sopenharmony_ci const struct pci_device_id *id; 4198c2ecf20Sopenharmony_ci int retVal; 4208c2ecf20Sopenharmony_ci 4218c2ecf20Sopenharmony_ci pdev = NULL; 4228c2ecf20Sopenharmony_ci for (id = esb2rom_pci_tbl; id->vendor; id++) { 4238c2ecf20Sopenharmony_ci printk(KERN_DEBUG "device id = %x\n", id->device); 4248c2ecf20Sopenharmony_ci pdev = pci_get_device(id->vendor, id->device, NULL); 4258c2ecf20Sopenharmony_ci if (pdev) { 4268c2ecf20Sopenharmony_ci printk(KERN_DEBUG "matched device = %x\n", id->device); 4278c2ecf20Sopenharmony_ci break; 4288c2ecf20Sopenharmony_ci } 4298c2ecf20Sopenharmony_ci } 4308c2ecf20Sopenharmony_ci if (pdev) { 4318c2ecf20Sopenharmony_ci printk(KERN_DEBUG "matched device id %x\n", id->device); 4328c2ecf20Sopenharmony_ci retVal = esb2rom_init_one(pdev, &esb2rom_pci_tbl[0]); 4338c2ecf20Sopenharmony_ci pci_dev_put(pdev); 4348c2ecf20Sopenharmony_ci printk(KERN_DEBUG "retVal = %d\n", retVal); 4358c2ecf20Sopenharmony_ci return retVal; 4368c2ecf20Sopenharmony_ci } 4378c2ecf20Sopenharmony_ci return -ENXIO; 4388c2ecf20Sopenharmony_ci#if 0 4398c2ecf20Sopenharmony_ci return pci_register_driver(&esb2rom_driver); 4408c2ecf20Sopenharmony_ci#endif 4418c2ecf20Sopenharmony_ci} 4428c2ecf20Sopenharmony_ci 4438c2ecf20Sopenharmony_cistatic void __exit cleanup_esb2rom(void) 4448c2ecf20Sopenharmony_ci{ 4458c2ecf20Sopenharmony_ci esb2rom_remove_one(esb2rom_window.pdev); 4468c2ecf20Sopenharmony_ci} 4478c2ecf20Sopenharmony_ci 4488c2ecf20Sopenharmony_cimodule_init(init_esb2rom); 4498c2ecf20Sopenharmony_cimodule_exit(cleanup_esb2rom); 4508c2ecf20Sopenharmony_ci 4518c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 4528c2ecf20Sopenharmony_ciMODULE_AUTHOR("Lew Glendenning <lglendenning@lnxi.com>"); 4538c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("MTD map driver for BIOS chips on the ESB2 southbridge"); 454