[PATCH] hostap: replace kmalloc+memset with kzalloc
[linux-2.6/mini2440.git] / drivers / net / wireless / hostap / hostap_pci.c
blobc4f6020baa9ee7d12bde7e27ab3aebac4bc9f842
1 #define PRISM2_PCI
3 /* Host AP driver's support for Intersil Prism2.5 PCI cards is based on
4 * driver patches from Reyk Floeter <reyk@vantronix.net> and
5 * Andy Warner <andyw@pobox.com> */
7 #include <linux/module.h>
8 #include <linux/init.h>
9 #include <linux/if.h>
10 #include <linux/skbuff.h>
11 #include <linux/netdevice.h>
12 #include <linux/workqueue.h>
13 #include <linux/wireless.h>
14 #include <net/iw_handler.h>
16 #include <linux/ioport.h>
17 #include <linux/pci.h>
18 #include <asm/io.h>
20 #include "hostap_wlan.h"
23 static char *version = PRISM2_VERSION " (Jouni Malinen <jkmaline@cc.hut.fi>)";
24 static char *dev_info = "hostap_pci";
27 MODULE_AUTHOR("Jouni Malinen");
28 MODULE_DESCRIPTION("Support for Intersil Prism2.5-based 802.11 wireless LAN "
29 "PCI cards.");
30 MODULE_SUPPORTED_DEVICE("Intersil Prism2.5-based WLAN PCI cards");
31 MODULE_LICENSE("GPL");
32 MODULE_VERSION(PRISM2_VERSION);
35 /* struct local_info::hw_priv */
36 struct hostap_pci_priv {
37 void __iomem *mem_start;
41 /* FIX: do we need mb/wmb/rmb with memory operations? */
44 static struct pci_device_id prism2_pci_id_table[] __devinitdata = {
45 /* Intersil Prism3 ISL3872 11Mb/s WLAN Controller */
46 { 0x1260, 0x3872, PCI_ANY_ID, PCI_ANY_ID },
47 /* Intersil Prism2.5 ISL3874 11Mb/s WLAN Controller */
48 { 0x1260, 0x3873, PCI_ANY_ID, PCI_ANY_ID },
49 /* Samsung MagicLAN SWL-2210P */
50 { 0x167d, 0xa000, PCI_ANY_ID, PCI_ANY_ID },
51 { 0 }
55 #ifdef PRISM2_IO_DEBUG
57 static inline void hfa384x_outb_debug(struct net_device *dev, int a, u8 v)
59 struct hostap_interface *iface;
60 struct hostap_pci_priv *hw_priv;
61 local_info_t *local;
62 unsigned long flags;
64 iface = netdev_priv(dev);
65 local = iface->local;
66 hw_priv = local->hw_priv;
68 spin_lock_irqsave(&local->lock, flags);
69 prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_OUTB, a, v);
70 writeb(v, hw_priv->mem_start + a);
71 spin_unlock_irqrestore(&local->lock, flags);
74 static inline u8 hfa384x_inb_debug(struct net_device *dev, int a)
76 struct hostap_interface *iface;
77 struct hostap_pci_priv *hw_priv;
78 local_info_t *local;
79 unsigned long flags;
80 u8 v;
82 iface = netdev_priv(dev);
83 local = iface->local;
84 hw_priv = local->hw_priv;
86 spin_lock_irqsave(&local->lock, flags);
87 v = readb(hw_priv->mem_start + a);
88 prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_INB, a, v);
89 spin_unlock_irqrestore(&local->lock, flags);
90 return v;
93 static inline void hfa384x_outw_debug(struct net_device *dev, int a, u16 v)
95 struct hostap_interface *iface;
96 struct hostap_pci_priv *hw_priv;
97 local_info_t *local;
98 unsigned long flags;
100 iface = netdev_priv(dev);
101 local = iface->local;
102 hw_priv = local->hw_priv;
104 spin_lock_irqsave(&local->lock, flags);
105 prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_OUTW, a, v);
106 writew(v, hw_priv->mem_start + a);
107 spin_unlock_irqrestore(&local->lock, flags);
110 static inline u16 hfa384x_inw_debug(struct net_device *dev, int a)
112 struct hostap_interface *iface;
113 struct hostap_pci_priv *hw_priv;
114 local_info_t *local;
115 unsigned long flags;
116 u16 v;
118 iface = netdev_priv(dev);
119 local = iface->local;
120 hw_priv = local->hw_priv;
122 spin_lock_irqsave(&local->lock, flags);
123 v = readw(hw_priv->mem_start + a);
124 prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_INW, a, v);
125 spin_unlock_irqrestore(&local->lock, flags);
126 return v;
129 #define HFA384X_OUTB(v,a) hfa384x_outb_debug(dev, (a), (v))
130 #define HFA384X_INB(a) hfa384x_inb_debug(dev, (a))
131 #define HFA384X_OUTW(v,a) hfa384x_outw_debug(dev, (a), (v))
132 #define HFA384X_INW(a) hfa384x_inw_debug(dev, (a))
133 #define HFA384X_OUTW_DATA(v,a) hfa384x_outw_debug(dev, (a), cpu_to_le16((v)))
134 #define HFA384X_INW_DATA(a) (u16) le16_to_cpu(hfa384x_inw_debug(dev, (a)))
136 #else /* PRISM2_IO_DEBUG */
138 static inline void hfa384x_outb(struct net_device *dev, int a, u8 v)
140 struct hostap_interface *iface;
141 struct hostap_pci_priv *hw_priv;
142 iface = netdev_priv(dev);
143 hw_priv = iface->local->hw_priv;
144 writeb(v, hw_priv->mem_start + a);
147 static inline u8 hfa384x_inb(struct net_device *dev, int a)
149 struct hostap_interface *iface;
150 struct hostap_pci_priv *hw_priv;
151 iface = netdev_priv(dev);
152 hw_priv = iface->local->hw_priv;
153 return readb(hw_priv->mem_start + a);
156 static inline void hfa384x_outw(struct net_device *dev, int a, u16 v)
158 struct hostap_interface *iface;
159 struct hostap_pci_priv *hw_priv;
160 iface = netdev_priv(dev);
161 hw_priv = iface->local->hw_priv;
162 writew(v, hw_priv->mem_start + a);
165 static inline u16 hfa384x_inw(struct net_device *dev, int a)
167 struct hostap_interface *iface;
168 struct hostap_pci_priv *hw_priv;
169 iface = netdev_priv(dev);
170 hw_priv = iface->local->hw_priv;
171 return readw(hw_priv->mem_start + a);
174 #define HFA384X_OUTB(v,a) hfa384x_outb(dev, (a), (v))
175 #define HFA384X_INB(a) hfa384x_inb(dev, (a))
176 #define HFA384X_OUTW(v,a) hfa384x_outw(dev, (a), (v))
177 #define HFA384X_INW(a) hfa384x_inw(dev, (a))
178 #define HFA384X_OUTW_DATA(v,a) hfa384x_outw(dev, (a), cpu_to_le16((v)))
179 #define HFA384X_INW_DATA(a) (u16) le16_to_cpu(hfa384x_inw(dev, (a)))
181 #endif /* PRISM2_IO_DEBUG */
184 static int hfa384x_from_bap(struct net_device *dev, u16 bap, void *buf,
185 int len)
187 u16 d_off;
188 u16 *pos;
190 d_off = (bap == 1) ? HFA384X_DATA1_OFF : HFA384X_DATA0_OFF;
191 pos = (u16 *) buf;
193 for ( ; len > 1; len -= 2)
194 *pos++ = HFA384X_INW_DATA(d_off);
196 if (len & 1)
197 *((char *) pos) = HFA384X_INB(d_off);
199 return 0;
203 static int hfa384x_to_bap(struct net_device *dev, u16 bap, void *buf, int len)
205 u16 d_off;
206 u16 *pos;
208 d_off = (bap == 1) ? HFA384X_DATA1_OFF : HFA384X_DATA0_OFF;
209 pos = (u16 *) buf;
211 for ( ; len > 1; len -= 2)
212 HFA384X_OUTW_DATA(*pos++, d_off);
214 if (len & 1)
215 HFA384X_OUTB(*((char *) pos), d_off);
217 return 0;
221 /* FIX: This might change at some point.. */
222 #include "hostap_hw.c"
224 static void prism2_pci_cor_sreset(local_info_t *local)
226 struct net_device *dev = local->dev;
227 u16 reg;
229 reg = HFA384X_INB(HFA384X_PCICOR_OFF);
230 printk(KERN_DEBUG "%s: Original COR value: 0x%0x\n", dev->name, reg);
232 /* linux-wlan-ng uses extremely long hold and settle times for
233 * COR sreset. A comment in the driver code mentions that the long
234 * delays appear to be necessary. However, at least IBM 22P6901 seems
235 * to work fine with shorter delays.
237 * Longer delays can be configured by uncommenting following line: */
238 /* #define PRISM2_PCI_USE_LONG_DELAYS */
240 #ifdef PRISM2_PCI_USE_LONG_DELAYS
241 int i;
243 HFA384X_OUTW(reg | 0x0080, HFA384X_PCICOR_OFF);
244 mdelay(250);
246 HFA384X_OUTW(reg & ~0x0080, HFA384X_PCICOR_OFF);
247 mdelay(500);
249 /* Wait for f/w to complete initialization (CMD:BUSY == 0) */
250 i = 2000000 / 10;
251 while ((HFA384X_INW(HFA384X_CMD_OFF) & HFA384X_CMD_BUSY) && --i)
252 udelay(10);
254 #else /* PRISM2_PCI_USE_LONG_DELAYS */
256 HFA384X_OUTW(reg | 0x0080, HFA384X_PCICOR_OFF);
257 mdelay(2);
258 HFA384X_OUTW(reg & ~0x0080, HFA384X_PCICOR_OFF);
259 mdelay(2);
261 #endif /* PRISM2_PCI_USE_LONG_DELAYS */
263 if (HFA384X_INW(HFA384X_CMD_OFF) & HFA384X_CMD_BUSY) {
264 printk(KERN_DEBUG "%s: COR sreset timeout\n", dev->name);
269 static void prism2_pci_genesis_reset(local_info_t *local, int hcr)
271 struct net_device *dev = local->dev;
273 HFA384X_OUTW(0x00C5, HFA384X_PCICOR_OFF);
274 mdelay(10);
275 HFA384X_OUTW(hcr, HFA384X_PCIHCR_OFF);
276 mdelay(10);
277 HFA384X_OUTW(0x0045, HFA384X_PCICOR_OFF);
278 mdelay(10);
282 static struct prism2_helper_functions prism2_pci_funcs =
284 .card_present = NULL,
285 .cor_sreset = prism2_pci_cor_sreset,
286 .genesis_reset = prism2_pci_genesis_reset,
287 .hw_type = HOSTAP_HW_PCI,
291 static int prism2_pci_probe(struct pci_dev *pdev,
292 const struct pci_device_id *id)
294 unsigned long phymem;
295 void __iomem *mem = NULL;
296 local_info_t *local = NULL;
297 struct net_device *dev = NULL;
298 static int cards_found /* = 0 */;
299 int irq_registered = 0;
300 struct hostap_interface *iface;
301 struct hostap_pci_priv *hw_priv;
303 hw_priv = kzalloc(sizeof(*hw_priv), GFP_KERNEL);
304 if (hw_priv == NULL)
305 return -ENOMEM;
307 if (pci_enable_device(pdev))
308 goto err_out_free;
310 phymem = pci_resource_start(pdev, 0);
312 if (!request_mem_region(phymem, pci_resource_len(pdev, 0), "Prism2")) {
313 printk(KERN_ERR "prism2: Cannot reserve PCI memory region\n");
314 goto err_out_disable;
317 mem = ioremap(phymem, pci_resource_len(pdev, 0));
318 if (mem == NULL) {
319 printk(KERN_ERR "prism2: Cannot remap PCI memory region\n") ;
320 goto fail;
323 dev = prism2_init_local_data(&prism2_pci_funcs, cards_found,
324 &pdev->dev);
325 if (dev == NULL)
326 goto fail;
327 iface = netdev_priv(dev);
328 local = iface->local;
329 local->hw_priv = hw_priv;
330 cards_found++;
332 dev->irq = pdev->irq;
333 hw_priv->mem_start = mem;
335 prism2_pci_cor_sreset(local);
337 pci_set_drvdata(pdev, dev);
339 if (request_irq(dev->irq, prism2_interrupt, IRQF_SHARED, dev->name,
340 dev)) {
341 printk(KERN_WARNING "%s: request_irq failed\n", dev->name);
342 goto fail;
343 } else
344 irq_registered = 1;
346 if (!local->pri_only && prism2_hw_config(dev, 1)) {
347 printk(KERN_DEBUG "%s: hardware initialization failed\n",
348 dev_info);
349 goto fail;
352 printk(KERN_INFO "%s: Intersil Prism2.5 PCI: "
353 "mem=0x%lx, irq=%d\n", dev->name, phymem, dev->irq);
355 return hostap_hw_ready(dev);
357 fail:
358 if (irq_registered && dev)
359 free_irq(dev->irq, dev);
361 if (mem)
362 iounmap(mem);
364 release_mem_region(phymem, pci_resource_len(pdev, 0));
366 err_out_disable:
367 pci_disable_device(pdev);
368 prism2_free_local_data(dev);
370 err_out_free:
371 kfree(hw_priv);
373 return -ENODEV;
377 static void prism2_pci_remove(struct pci_dev *pdev)
379 struct net_device *dev;
380 struct hostap_interface *iface;
381 void __iomem *mem_start;
382 struct hostap_pci_priv *hw_priv;
384 dev = pci_get_drvdata(pdev);
385 iface = netdev_priv(dev);
386 hw_priv = iface->local->hw_priv;
388 /* Reset the hardware, and ensure interrupts are disabled. */
389 prism2_pci_cor_sreset(iface->local);
390 hfa384x_disable_interrupts(dev);
392 if (dev->irq)
393 free_irq(dev->irq, dev);
395 mem_start = hw_priv->mem_start;
396 prism2_free_local_data(dev);
397 kfree(hw_priv);
399 iounmap(mem_start);
401 release_mem_region(pci_resource_start(pdev, 0),
402 pci_resource_len(pdev, 0));
403 pci_disable_device(pdev);
407 #ifdef CONFIG_PM
408 static int prism2_pci_suspend(struct pci_dev *pdev, pm_message_t state)
410 struct net_device *dev = pci_get_drvdata(pdev);
412 if (netif_running(dev)) {
413 netif_stop_queue(dev);
414 netif_device_detach(dev);
416 prism2_suspend(dev);
417 pci_save_state(pdev);
418 pci_disable_device(pdev);
419 pci_set_power_state(pdev, PCI_D3hot);
421 return 0;
424 static int prism2_pci_resume(struct pci_dev *pdev)
426 struct net_device *dev = pci_get_drvdata(pdev);
427 int err;
429 err = pci_enable_device(pdev);
430 if (err) {
431 printk(KERN_ERR "%s: pci_enable_device failed on resume\n",
432 dev->name);
433 return err;
435 pci_restore_state(pdev);
436 prism2_hw_config(dev, 0);
437 if (netif_running(dev)) {
438 netif_device_attach(dev);
439 netif_start_queue(dev);
442 return 0;
444 #endif /* CONFIG_PM */
447 MODULE_DEVICE_TABLE(pci, prism2_pci_id_table);
449 static struct pci_driver prism2_pci_drv_id = {
450 .name = "hostap_pci",
451 .id_table = prism2_pci_id_table,
452 .probe = prism2_pci_probe,
453 .remove = prism2_pci_remove,
454 #ifdef CONFIG_PM
455 .suspend = prism2_pci_suspend,
456 .resume = prism2_pci_resume,
457 #endif /* CONFIG_PM */
458 /* Linux 2.4.6 added save_state and enable_wake that are not used here
463 static int __init init_prism2_pci(void)
465 printk(KERN_INFO "%s: %s\n", dev_info, version);
467 return pci_register_driver(&prism2_pci_drv_id);
471 static void __exit exit_prism2_pci(void)
473 pci_unregister_driver(&prism2_pci_drv_id);
474 printk(KERN_INFO "%s: Driver unloaded\n", dev_info);
478 module_init(init_prism2_pci);
479 module_exit(exit_prism2_pci);