[IPV4]: fix alignment of IP-Config output
[linux-2.6/mini2440.git] / drivers / pcmcia / cardbus.c
blob714baaeb6da1257a264c903b4b36d67570c15486
1 /*
2 * cardbus.c -- 16-bit PCMCIA core support
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
8 * The initial developer of the original code is David A. Hinds
9 * <dahinds@users.sourceforge.net>. Portions created by David A. Hinds
10 * are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
12 * (C) 1999 David A. Hinds
16 * Cardbus handling has been re-written to be more of a PCI bridge thing,
17 * and the PCI code basically does all the resource handling.
19 * Linus, Jan 2000
23 #include <linux/module.h>
24 #include <linux/kernel.h>
25 #include <linux/string.h>
26 #include <linux/slab.h>
27 #include <linux/mm.h>
28 #include <linux/pci.h>
29 #include <linux/ioport.h>
30 #include <asm/irq.h>
31 #include <asm/io.h>
33 #define IN_CARD_SERVICES
34 #include <pcmcia/cs_types.h>
35 #include <pcmcia/ss.h>
36 #include <pcmcia/cs.h>
37 #include <pcmcia/bulkmem.h>
38 #include <pcmcia/cistpl.h>
39 #include "cs_internal.h"
41 /*====================================================================*/
43 /* Offsets in the Expansion ROM Image Header */
44 #define ROM_SIGNATURE 0x0000 /* 2 bytes */
45 #define ROM_DATA_PTR 0x0018 /* 2 bytes */
47 /* Offsets in the CardBus PC Card Data Structure */
48 #define PCDATA_SIGNATURE 0x0000 /* 4 bytes */
49 #define PCDATA_VPD_PTR 0x0008 /* 2 bytes */
50 #define PCDATA_LENGTH 0x000a /* 2 bytes */
51 #define PCDATA_REVISION 0x000c
52 #define PCDATA_IMAGE_SZ 0x0010 /* 2 bytes */
53 #define PCDATA_ROM_LEVEL 0x0012 /* 2 bytes */
54 #define PCDATA_CODE_TYPE 0x0014
55 #define PCDATA_INDICATOR 0x0015
57 /*=====================================================================
59 Expansion ROM's have a special layout, and pointers specify an
60 image number and an offset within that image. xlate_rom_addr()
61 converts an image/offset address to an absolute offset from the
62 ROM's base address.
64 =====================================================================*/
66 static u_int xlate_rom_addr(void __iomem *b, u_int addr)
68 u_int img = 0, ofs = 0, sz;
69 u_short data;
70 while ((readb(b) == 0x55) && (readb(b + 1) == 0xaa)) {
71 if (img == (addr >> 28))
72 return (addr & 0x0fffffff) + ofs;
73 data = readb(b + ROM_DATA_PTR) + (readb(b + ROM_DATA_PTR + 1) << 8);
74 sz = 512 * (readb(b + data + PCDATA_IMAGE_SZ) +
75 (readb(b + data + PCDATA_IMAGE_SZ + 1) << 8));
76 if ((sz == 0) || (readb(b + data + PCDATA_INDICATOR) & 0x80))
77 break;
78 b += sz;
79 ofs += sz;
80 img++;
82 return 0;
85 /*=====================================================================
87 These are similar to setup_cis_mem and release_cis_mem for 16-bit
88 cards. The "result" that is used externally is the cb_cis_virt
89 pointer in the struct pcmcia_socket structure.
91 =====================================================================*/
93 static void cb_release_cis_mem(struct pcmcia_socket * s)
95 if (s->cb_cis_virt) {
96 cs_dbg(s, 1, "cb_release_cis_mem()\n");
97 iounmap(s->cb_cis_virt);
98 s->cb_cis_virt = NULL;
99 s->cb_cis_res = NULL;
103 static int cb_setup_cis_mem(struct pcmcia_socket * s, struct resource *res)
105 unsigned int start, size;
107 if (res == s->cb_cis_res)
108 return 0;
110 if (s->cb_cis_res)
111 cb_release_cis_mem(s);
113 start = res->start;
114 size = res->end - start + 1;
115 s->cb_cis_virt = ioremap(start, size);
117 if (!s->cb_cis_virt)
118 return -1;
120 s->cb_cis_res = res;
122 return 0;
125 /*=====================================================================
127 This is used by the CIS processing code to read CIS information
128 from a CardBus device.
130 =====================================================================*/
132 int read_cb_mem(struct pcmcia_socket * s, int space, u_int addr, u_int len, void *ptr)
134 struct pci_dev *dev;
135 struct resource *res;
137 cs_dbg(s, 3, "read_cb_mem(%d, %#x, %u)\n", space, addr, len);
139 dev = pci_get_slot(s->cb_dev->subordinate, 0);
140 if (!dev)
141 goto fail;
143 /* Config space? */
144 if (space == 0) {
145 if (addr + len > 0x100)
146 goto failput;
147 for (; len; addr++, ptr++, len--)
148 pci_read_config_byte(dev, addr, ptr);
149 return 0;
152 res = dev->resource + space - 1;
154 pci_dev_put(dev);
156 if (!res->flags)
157 goto fail;
159 if (cb_setup_cis_mem(s, res) != 0)
160 goto fail;
162 if (space == 7) {
163 addr = xlate_rom_addr(s->cb_cis_virt, addr);
164 if (addr == 0)
165 goto fail;
168 if (addr + len > res->end - res->start)
169 goto fail;
171 memcpy_fromio(ptr, s->cb_cis_virt + addr, len);
172 return 0;
174 failput:
175 pci_dev_put(dev);
176 fail:
177 memset(ptr, 0xff, len);
178 return -1;
181 /*=====================================================================
183 cb_alloc() and cb_free() allocate and free the kernel data
184 structures for a Cardbus device, and handle the lowest level PCI
185 device setup issues.
187 =====================================================================*/
190 * Since there is only one interrupt available to CardBus
191 * devices, all devices downstream of this device must
192 * be using this IRQ.
194 static void cardbus_assign_irqs(struct pci_bus *bus, int irq)
196 struct pci_dev *dev;
198 list_for_each_entry(dev, &bus->devices, bus_list) {
199 u8 irq_pin;
201 pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq_pin);
202 if (irq_pin) {
203 dev->irq = irq;
204 pci_write_config_byte(dev, PCI_INTERRUPT_LINE, dev->irq);
207 if (dev->subordinate)
208 cardbus_assign_irqs(dev->subordinate, irq);
212 int cb_alloc(struct pcmcia_socket * s)
214 struct pci_bus *bus = s->cb_dev->subordinate;
215 struct pci_dev *dev;
216 unsigned int max, pass;
218 s->functions = pci_scan_slot(bus, PCI_DEVFN(0, 0));
219 // pcibios_fixup_bus(bus);
221 max = bus->secondary;
222 for (pass = 0; pass < 2; pass++)
223 list_for_each_entry(dev, &bus->devices, bus_list)
224 if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
225 dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
226 max = pci_scan_bridge(bus, dev, max, pass);
229 * Size all resources below the CardBus controller.
231 pci_bus_size_bridges(bus);
232 pci_bus_assign_resources(bus);
233 cardbus_assign_irqs(bus, s->pci_irq);
235 /* socket specific tune function */
236 if (s->tune_bridge)
237 s->tune_bridge(s, bus);
239 pci_enable_bridges(bus);
240 pci_bus_add_devices(bus);
242 s->irq.AssignedIRQ = s->pci_irq;
243 return CS_SUCCESS;
246 void cb_free(struct pcmcia_socket * s)
248 struct pci_dev *bridge = s->cb_dev;
250 cb_release_cis_mem(s);
252 if (bridge)
253 pci_remove_behind_bridge(bridge);