| /* | |
| * cardbus.c -- 16-bit PCMCIA core support | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of the GNU General Public License version 2 as | |
| * published by the Free Software Foundation. | |
| * | |
| * The initial developer of the original code is David A. Hinds | |
| * <dahinds@users.sourceforge.net>. Portions created by David A. Hinds | |
| * are Copyright (C) 1999 David A. Hinds. All Rights Reserved. | |
| * | |
| * (C) 1999 David A. Hinds | |
| */ | |
| /* | |
| * Cardbus handling has been re-written to be more of a PCI bridge thing, | |
| * and the PCI code basically does all the resource handling. | |
| * | |
| * Linus, Jan 2000 | |
| */ | |
| #include <linux/module.h> | |
| #include <linux/kernel.h> | |
| #include <linux/string.h> | |
| #include <linux/slab.h> | |
| #include <linux/mm.h> | |
| #include <linux/pci.h> | |
| #include <linux/ioport.h> | |
| #include <asm/irq.h> | |
| #include <asm/io.h> | |
| #define IN_CARD_SERVICES | |
| #include <pcmcia/cs_types.h> | |
| #include <pcmcia/ss.h> | |
| #include <pcmcia/cs.h> | |
| #include <pcmcia/bulkmem.h> | |
| #include <pcmcia/cistpl.h> | |
| #include "cs_internal.h" | |
| /*====================================================================*/ | |
| #define FIND_FIRST_BIT(n) ((n) - ((n) & ((n)-1))) | |
| /* Offsets in the Expansion ROM Image Header */ | |
| #define ROM_SIGNATURE 0x0000 /* 2 bytes */ | |
| #define ROM_DATA_PTR 0x0018 /* 2 bytes */ | |
| /* Offsets in the CardBus PC Card Data Structure */ | |
| #define PCDATA_SIGNATURE 0x0000 /* 4 bytes */ | |
| #define PCDATA_VPD_PTR 0x0008 /* 2 bytes */ | |
| #define PCDATA_LENGTH 0x000a /* 2 bytes */ | |
| #define PCDATA_REVISION 0x000c | |
| #define PCDATA_IMAGE_SZ 0x0010 /* 2 bytes */ | |
| #define PCDATA_ROM_LEVEL 0x0012 /* 2 bytes */ | |
| #define PCDATA_CODE_TYPE 0x0014 | |
| #define PCDATA_INDICATOR 0x0015 | |
| /*===================================================================== | |
| Expansion ROM's have a special layout, and pointers specify an | |
| image number and an offset within that image. xlate_rom_addr() | |
| converts an image/offset address to an absolute offset from the | |
| ROM's base address. | |
| =====================================================================*/ | |
| static u_int xlate_rom_addr(void __iomem *b, u_int addr) | |
| { | |
| u_int img = 0, ofs = 0, sz; | |
| u_short data; | |
| while ((readb(b) == 0x55) && (readb(b + 1) == 0xaa)) { | |
| if (img == (addr >> 28)) | |
| return (addr & 0x0fffffff) + ofs; | |
| data = readb(b + ROM_DATA_PTR) + (readb(b + ROM_DATA_PTR + 1) << 8); | |
| sz = 512 * (readb(b + data + PCDATA_IMAGE_SZ) + | |
| (readb(b + data + PCDATA_IMAGE_SZ + 1) << 8)); | |
| if ((sz == 0) || (readb(b + data + PCDATA_INDICATOR) & 0x80)) | |
| break; | |
| b += sz; | |
| ofs += sz; | |
| img++; | |
| } | |
| return 0; | |
| } | |
| /*===================================================================== | |
| These are similar to setup_cis_mem and release_cis_mem for 16-bit | |
| cards. The "result" that is used externally is the cb_cis_virt | |
| pointer in the struct pcmcia_socket structure. | |
| =====================================================================*/ | |
| static void cb_release_cis_mem(struct pcmcia_socket * s) | |
| { | |
| if (s->cb_cis_virt) { | |
| cs_dbg(s, 1, "cb_release_cis_mem()\n"); | |
| iounmap(s->cb_cis_virt); | |
| s->cb_cis_virt = NULL; | |
| s->cb_cis_res = NULL; | |
| } | |
| } | |
| static int cb_setup_cis_mem(struct pcmcia_socket * s, struct resource *res) | |
| { | |
| unsigned int start, size; | |
| if (res == s->cb_cis_res) | |
| return 0; | |
| if (s->cb_cis_res) | |
| cb_release_cis_mem(s); | |
| start = res->start; | |
| size = res->end - start + 1; | |
| s->cb_cis_virt = ioremap(start, size); | |
| if (!s->cb_cis_virt) | |
| return -1; | |
| s->cb_cis_res = res; | |
| return 0; | |
| } | |
| /*===================================================================== | |
| This is used by the CIS processing code to read CIS information | |
| from a CardBus device. | |
| =====================================================================*/ | |
| int read_cb_mem(struct pcmcia_socket * s, int space, u_int addr, u_int len, void *ptr) | |
| { | |
| struct pci_dev *dev; | |
| struct resource *res; | |
| cs_dbg(s, 3, "read_cb_mem(%d, %#x, %u)\n", space, addr, len); | |
| dev = pci_get_slot(s->cb_dev->subordinate, 0); | |
| if (!dev) | |
| goto fail; | |
| /* Config space? */ | |
| if (space == 0) { | |
| if (addr + len > 0x100) | |
| goto fail; | |
| for (; len; addr++, ptr++, len--) | |
| pci_read_config_byte(dev, addr, ptr); | |
| return 0; | |
| } | |
| res = dev->resource + space - 1; | |
| pci_dev_put(dev); | |
| if (!res->flags) | |
| goto fail; | |
| if (cb_setup_cis_mem(s, res) != 0) | |
| goto fail; | |
| if (space == 7) { | |
| addr = xlate_rom_addr(s->cb_cis_virt, addr); | |
| if (addr == 0) | |
| goto fail; | |
| } | |
| if (addr + len > res->end - res->start) | |
| goto fail; | |
| memcpy_fromio(ptr, s->cb_cis_virt + addr, len); | |
| return 0; | |
| fail: | |
| memset(ptr, 0xff, len); | |
| return -1; | |
| } | |
| /*===================================================================== | |
| cb_alloc() and cb_free() allocate and free the kernel data | |
| structures for a Cardbus device, and handle the lowest level PCI | |
| device setup issues. | |
| =====================================================================*/ | |
| /* | |
| * Since there is only one interrupt available to CardBus | |
| * devices, all devices downstream of this device must | |
| * be using this IRQ. | |
| */ | |
| static void cardbus_assign_irqs(struct pci_bus *bus, int irq) | |
| { | |
| struct pci_dev *dev; | |
| list_for_each_entry(dev, &bus->devices, bus_list) { | |
| u8 irq_pin; | |
| pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq_pin); | |
| if (irq_pin) { | |
| dev->irq = irq; | |
| pci_write_config_byte(dev, PCI_INTERRUPT_LINE, dev->irq); | |
| } | |
| if (dev->subordinate) | |
| cardbus_assign_irqs(dev->subordinate, irq); | |
| } | |
| } | |
| int cb_alloc(struct pcmcia_socket * s) | |
| { | |
| struct pci_bus *bus = s->cb_dev->subordinate; | |
| struct pci_dev *dev; | |
| unsigned int max, pass; | |
| s->functions = pci_scan_slot(bus, PCI_DEVFN(0, 0)); | |
| // pcibios_fixup_bus(bus); | |
| max = bus->secondary; | |
| for (pass = 0; pass < 2; pass++) | |
| list_for_each_entry(dev, &bus->devices, bus_list) | |
| if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE || | |
| dev->hdr_type == PCI_HEADER_TYPE_CARDBUS) | |
| max = pci_scan_bridge(bus, dev, max, pass); | |
| /* | |
| * Size all resources below the CardBus controller. | |
| */ | |
| pci_bus_size_bridges(bus); | |
| pci_bus_assign_resources(bus); | |
| cardbus_assign_irqs(bus, s->pci_irq); | |
| /* socket specific tune function */ | |
| if (s->tune_bridge) | |
| s->tune_bridge(s, bus); | |
| pci_enable_bridges(bus); | |
| pci_bus_add_devices(bus); | |
| s->irq.AssignedIRQ = s->pci_irq; | |
| return CS_SUCCESS; | |
| } | |
| void cb_free(struct pcmcia_socket * s) | |
| { | |
| struct pci_dev *bridge = s->cb_dev; | |
| cb_release_cis_mem(s); | |
| if (bridge) | |
| pci_remove_behind_bridge(bridge); | |
| } |