Diff markup
1 /* 1 /*
2 * cardbus.c -- 16-bit PCMCIA core support 2 * cardbus.c -- 16-bit PCMCIA core support
3 * 3 *
4 * This program is free software; you can redi 4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Publi 5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation. 6 * published by the Free Software Foundation.
7 * 7 *
8 * The initial developer of the original code 8 * The initial developer of the original code is David A. Hinds
9 * <dahinds@users.sourceforge.net>. Portions 9 * <dahinds@users.sourceforge.net>. Portions created by David A. Hinds
10 * are Copyright (C) 1999 David A. Hinds. All 10 * are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
11 * 11 *
12 * (C) 1999 David A. Hinds 12 * (C) 1999 David A. Hinds
13 */ 13 */
14 14
15 /* 15 /*
16 * Cardbus handling has been re-written to be 16 * Cardbus handling has been re-written to be more of a PCI bridge thing,
17 * and the PCI code basically does all the res 17 * and the PCI code basically does all the resource handling.
18 * 18 *
19 * Linus, Jan 2000 19 * Linus, Jan 2000
20 */ 20 */
21 21
22 22
23 #include <linux/module.h> 23 #include <linux/module.h>
24 #include <linux/kernel.h> 24 #include <linux/kernel.h>
25 #include <linux/string.h> 25 #include <linux/string.h>
26 #include <linux/slab.h> 26 #include <linux/slab.h>
27 #include <linux/mm.h> 27 #include <linux/mm.h>
28 #include <linux/pci.h> 28 #include <linux/pci.h>
29 #include <linux/ioport.h> 29 #include <linux/ioport.h>
30 #include <asm/irq.h> 30 #include <asm/irq.h>
31 #include <asm/io.h> 31 #include <asm/io.h>
32 32
33 #define IN_CARD_SERVICES 33 #define IN_CARD_SERVICES
>> 34 #include <pcmcia/version.h>
34 #include <pcmcia/cs_types.h> 35 #include <pcmcia/cs_types.h>
35 #include <pcmcia/ss.h> 36 #include <pcmcia/ss.h>
36 #include <pcmcia/cs.h> 37 #include <pcmcia/cs.h>
37 #include <pcmcia/bulkmem.h> 38 #include <pcmcia/bulkmem.h>
38 #include <pcmcia/cistpl.h> 39 #include <pcmcia/cistpl.h>
39 #include "cs_internal.h" 40 #include "cs_internal.h"
40 41
41 /*============================================ 42 /*====================================================================*/
42 43
>> 44 #define FIND_FIRST_BIT(n) ((n) - ((n) & ((n)-1)))
>> 45
43 /* Offsets in the Expansion ROM Image Header * 46 /* Offsets in the Expansion ROM Image Header */
44 #define ROM_SIGNATURE 0x0000 /* 2 b 47 #define ROM_SIGNATURE 0x0000 /* 2 bytes */
45 #define ROM_DATA_PTR 0x0018 /* 2 b 48 #define ROM_DATA_PTR 0x0018 /* 2 bytes */
46 49
47 /* Offsets in the CardBus PC Card Data Structu 50 /* Offsets in the CardBus PC Card Data Structure */
48 #define PCDATA_SIGNATURE 0x0000 /* 4 b 51 #define PCDATA_SIGNATURE 0x0000 /* 4 bytes */
49 #define PCDATA_VPD_PTR 0x0008 /* 2 b 52 #define PCDATA_VPD_PTR 0x0008 /* 2 bytes */
50 #define PCDATA_LENGTH 0x000a /* 2 b 53 #define PCDATA_LENGTH 0x000a /* 2 bytes */
51 #define PCDATA_REVISION 0x000c 54 #define PCDATA_REVISION 0x000c
52 #define PCDATA_IMAGE_SZ 0x0010 /* 2 b 55 #define PCDATA_IMAGE_SZ 0x0010 /* 2 bytes */
53 #define PCDATA_ROM_LEVEL 0x0012 /* 2 b 56 #define PCDATA_ROM_LEVEL 0x0012 /* 2 bytes */
54 #define PCDATA_CODE_TYPE 0x0014 57 #define PCDATA_CODE_TYPE 0x0014
55 #define PCDATA_INDICATOR 0x0015 58 #define PCDATA_INDICATOR 0x0015
56 59
57 /*============================================ 60 /*=====================================================================
58 61
59 Expansion ROM's have a special layout, and 62 Expansion ROM's have a special layout, and pointers specify an
60 image number and an offset within that ima 63 image number and an offset within that image. xlate_rom_addr()
61 converts an image/offset address to an abs 64 converts an image/offset address to an absolute offset from the
62 ROM's base address. 65 ROM's base address.
63 66
64 ============================================== 67 =====================================================================*/
65 68
66 static u_int xlate_rom_addr(void __iomem *b, u 69 static u_int xlate_rom_addr(void __iomem *b, u_int addr)
67 { 70 {
68 u_int img = 0, ofs = 0, sz; 71 u_int img = 0, ofs = 0, sz;
69 u_short data; 72 u_short data;
70 while ((readb(b) == 0x55) && (readb(b 73 while ((readb(b) == 0x55) && (readb(b + 1) == 0xaa)) {
71 if (img == (addr >> 28)) 74 if (img == (addr >> 28))
72 return (addr & 0x0ffff 75 return (addr & 0x0fffffff) + ofs;
73 data = readb(b + ROM_DATA_PTR) 76 data = readb(b + ROM_DATA_PTR) + (readb(b + ROM_DATA_PTR + 1) << 8);
74 sz = 512 * (readb(b + data + P 77 sz = 512 * (readb(b + data + PCDATA_IMAGE_SZ) +
75 (readb(b + data + 78 (readb(b + data + PCDATA_IMAGE_SZ + 1) << 8));
76 if ((sz == 0) || (readb(b + da 79 if ((sz == 0) || (readb(b + data + PCDATA_INDICATOR) & 0x80))
77 break; 80 break;
78 b += sz; 81 b += sz;
79 ofs += sz; 82 ofs += sz;
80 img++; 83 img++;
81 } 84 }
82 return 0; 85 return 0;
83 } 86 }
84 87
85 /*============================================ 88 /*=====================================================================
86 89
87 These are similar to setup_cis_mem and rel 90 These are similar to setup_cis_mem and release_cis_mem for 16-bit
88 cards. The "result" that is used external 91 cards. The "result" that is used externally is the cb_cis_virt
89 pointer in the struct pcmcia_socket struct 92 pointer in the struct pcmcia_socket structure.
90 93
91 ============================================== 94 =====================================================================*/
92 95
93 static void cb_release_cis_mem(struct pcmcia_s 96 static void cb_release_cis_mem(struct pcmcia_socket * s)
94 { 97 {
95 if (s->cb_cis_virt) { 98 if (s->cb_cis_virt) {
96 cs_dbg(s, 1, "cb_release_cis_m 99 cs_dbg(s, 1, "cb_release_cis_mem()\n");
97 iounmap(s->cb_cis_virt); 100 iounmap(s->cb_cis_virt);
98 s->cb_cis_virt = NULL; 101 s->cb_cis_virt = NULL;
99 s->cb_cis_res = NULL; 102 s->cb_cis_res = NULL;
100 } 103 }
101 } 104 }
102 105
103 static int cb_setup_cis_mem(struct pcmcia_sock 106 static int cb_setup_cis_mem(struct pcmcia_socket * s, struct resource *res)
104 { 107 {
105 unsigned int start, size; 108 unsigned int start, size;
106 109
107 if (res == s->cb_cis_res) 110 if (res == s->cb_cis_res)
108 return 0; 111 return 0;
109 112
110 if (s->cb_cis_res) 113 if (s->cb_cis_res)
111 cb_release_cis_mem(s); 114 cb_release_cis_mem(s);
112 115
113 start = res->start; 116 start = res->start;
114 size = res->end - start + 1; 117 size = res->end - start + 1;
115 s->cb_cis_virt = ioremap(start, size); 118 s->cb_cis_virt = ioremap(start, size);
116 119
117 if (!s->cb_cis_virt) 120 if (!s->cb_cis_virt)
118 return -1; 121 return -1;
119 122
120 s->cb_cis_res = res; 123 s->cb_cis_res = res;
121 124
122 return 0; 125 return 0;
123 } 126 }
124 127
125 /*============================================ 128 /*=====================================================================
126 129
127 This is used by the CIS processing code to 130 This is used by the CIS processing code to read CIS information
128 from a CardBus device. 131 from a CardBus device.
129 132
130 ============================================== 133 =====================================================================*/
131 134
132 int read_cb_mem(struct pcmcia_socket * s, int 135 int read_cb_mem(struct pcmcia_socket * s, int space, u_int addr, u_int len, void *ptr)
133 { 136 {
134 struct pci_dev *dev; 137 struct pci_dev *dev;
135 struct resource *res; 138 struct resource *res;
136 139
137 cs_dbg(s, 3, "read_cb_mem(%d, %#x, %u) 140 cs_dbg(s, 3, "read_cb_mem(%d, %#x, %u)\n", space, addr, len);
138 141
139 dev = pci_get_slot(s->cb_dev->subordin !! 142 dev = pci_find_slot(s->cb_dev->subordinate->number, 0);
140 if (!dev) 143 if (!dev)
141 goto fail; 144 goto fail;
142 145
143 /* Config space? */ 146 /* Config space? */
144 if (space == 0) { 147 if (space == 0) {
145 if (addr + len > 0x100) 148 if (addr + len > 0x100)
146 goto failput; !! 149 goto fail;
147 for (; len; addr++, ptr++, len 150 for (; len; addr++, ptr++, len--)
148 pci_read_config_byte(d 151 pci_read_config_byte(dev, addr, ptr);
149 return 0; 152 return 0;
150 } 153 }
151 154
152 res = dev->resource + space - 1; 155 res = dev->resource + space - 1;
153 <<
154 pci_dev_put(dev); <<
155 <<
156 if (!res->flags) 156 if (!res->flags)
157 goto fail; 157 goto fail;
158 158
159 if (cb_setup_cis_mem(s, res) != 0) 159 if (cb_setup_cis_mem(s, res) != 0)
160 goto fail; 160 goto fail;
161 161
162 if (space == 7) { 162 if (space == 7) {
163 addr = xlate_rom_addr(s->cb_ci 163 addr = xlate_rom_addr(s->cb_cis_virt, addr);
164 if (addr == 0) 164 if (addr == 0)
165 goto fail; 165 goto fail;
166 } 166 }
167 167
168 if (addr + len > res->end - res->start 168 if (addr + len > res->end - res->start)
169 goto fail; 169 goto fail;
170 170
171 memcpy_fromio(ptr, s->cb_cis_virt + ad 171 memcpy_fromio(ptr, s->cb_cis_virt + addr, len);
172 return 0; 172 return 0;
173 173
174 failput: <<
175 pci_dev_put(dev); <<
176 fail: 174 fail:
177 memset(ptr, 0xff, len); 175 memset(ptr, 0xff, len);
178 return -1; 176 return -1;
179 } 177 }
180 178
181 /*============================================ 179 /*=====================================================================
182 180
183 cb_alloc() and cb_free() allocate and free 181 cb_alloc() and cb_free() allocate and free the kernel data
184 structures for a Cardbus device, and handl 182 structures for a Cardbus device, and handle the lowest level PCI
185 device setup issues. 183 device setup issues.
186 184
187 ============================================== 185 =====================================================================*/
188 186
189 /* 187 /*
190 * Since there is only one interrupt available 188 * Since there is only one interrupt available to CardBus
191 * devices, all devices downstream of this dev 189 * devices, all devices downstream of this device must
192 * be using this IRQ. 190 * be using this IRQ.
193 */ 191 */
194 static void cardbus_assign_irqs(struct pci_bus 192 static void cardbus_assign_irqs(struct pci_bus *bus, int irq)
195 { 193 {
196 struct pci_dev *dev; 194 struct pci_dev *dev;
197 195
198 list_for_each_entry(dev, &bus->devices 196 list_for_each_entry(dev, &bus->devices, bus_list) {
199 u8 irq_pin; 197 u8 irq_pin;
200 198
201 pci_read_config_byte(dev, PCI_ 199 pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq_pin);
202 if (irq_pin) { 200 if (irq_pin) {
203 dev->irq = irq; 201 dev->irq = irq;
204 pci_write_config_byte( 202 pci_write_config_byte(dev, PCI_INTERRUPT_LINE, dev->irq);
205 } 203 }
206 204
207 if (dev->subordinate) 205 if (dev->subordinate)
208 cardbus_assign_irqs(de 206 cardbus_assign_irqs(dev->subordinate, irq);
209 } 207 }
210 } 208 }
211 209
212 int cb_alloc(struct pcmcia_socket * s) 210 int cb_alloc(struct pcmcia_socket * s)
213 { 211 {
214 struct pci_bus *bus = s->cb_dev->subor 212 struct pci_bus *bus = s->cb_dev->subordinate;
215 struct pci_dev *dev; 213 struct pci_dev *dev;
216 unsigned int max, pass; 214 unsigned int max, pass;
217 215
218 s->functions = pci_scan_slot(bus, PCI_ 216 s->functions = pci_scan_slot(bus, PCI_DEVFN(0, 0));
219 // pcibios_fixup_bus(bus); 217 // pcibios_fixup_bus(bus);
220 218
221 max = bus->secondary; 219 max = bus->secondary;
222 for (pass = 0; pass < 2; pass++) 220 for (pass = 0; pass < 2; pass++)
223 list_for_each_entry(dev, &bus- 221 list_for_each_entry(dev, &bus->devices, bus_list)
224 if (dev->hdr_type == P 222 if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
225 dev->hdr_type == P 223 dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
226 max = pci_scan 224 max = pci_scan_bridge(bus, dev, max, pass);
227 225
228 /* 226 /*
229 * Size all resources below the CardBu 227 * Size all resources below the CardBus controller.
230 */ 228 */
231 pci_bus_size_bridges(bus); 229 pci_bus_size_bridges(bus);
232 pci_bus_assign_resources(bus); 230 pci_bus_assign_resources(bus);
233 cardbus_assign_irqs(bus, s->pci_irq); 231 cardbus_assign_irqs(bus, s->pci_irq);
234 <<
235 /* socket specific tune function */ <<
236 if (s->tune_bridge) <<
237 s->tune_bridge(s, bus); <<
238 <<
239 pci_enable_bridges(bus); 232 pci_enable_bridges(bus);
240 pci_bus_add_devices(bus); 233 pci_bus_add_devices(bus);
241 234
242 s->irq.AssignedIRQ = s->pci_irq; 235 s->irq.AssignedIRQ = s->pci_irq;
243 return CS_SUCCESS; 236 return CS_SUCCESS;
244 } 237 }
245 238
246 void cb_free(struct pcmcia_socket * s) 239 void cb_free(struct pcmcia_socket * s)
247 { 240 {
248 struct pci_dev *bridge = s->cb_dev; 241 struct pci_dev *bridge = s->cb_dev;
249 242
250 cb_release_cis_mem(s); 243 cb_release_cis_mem(s);
251 244
252 if (bridge) 245 if (bridge)
253 pci_remove_behind_bridge(bridg 246 pci_remove_behind_bridge(bridge);
254 } 247 }
255 248
|
This page was automatically generated by the
LXR engine.
|