1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/module.h>
24#include <linux/platform_device.h>
25#include <linux/interrupt.h>
26#include <linux/firmware.h>
27#include <linux/delay.h>
28#include <linux/irq.h>
29#include <linux/spi/spi.h>
30#include <linux/etherdevice.h>
31#include <linux/gpio.h>
32
33#include "p54spi.h"
34#include "p54spi_eeprom.h"
35#include "p54.h"
36
37#include "lmac.h"
38
39MODULE_FIRMWARE("3826.arm");
40MODULE_ALIAS("stlc45xx");
41
42
43
44
45
46
47
48static int p54spi_gpio_power = 97;
49module_param(p54spi_gpio_power, int, 0444);
50MODULE_PARM_DESC(p54spi_gpio_power, "gpio number for power line");
51
52static int p54spi_gpio_irq = 87;
53module_param(p54spi_gpio_irq, int, 0444);
54MODULE_PARM_DESC(p54spi_gpio_irq, "gpio number for irq line");
55
56static void p54spi_spi_read(struct p54s_priv *priv, u8 address,
57 void *buf, size_t len)
58{
59 struct spi_transfer t[2];
60 struct spi_message m;
61 __le16 addr;
62
63
64 addr = cpu_to_le16(address << 8 | SPI_ADRS_READ_BIT_15);
65
66 spi_message_init(&m);
67 memset(t, 0, sizeof(t));
68
69 t[0].tx_buf = &addr;
70 t[0].len = sizeof(addr);
71 spi_message_add_tail(&t[0], &m);
72
73 t[1].rx_buf = buf;
74 t[1].len = len;
75 spi_message_add_tail(&t[1], &m);
76
77 spi_sync(priv->spi, &m);
78}
79
80
81static void p54spi_spi_write(struct p54s_priv *priv, u8 address,
82 const void *buf, size_t len)
83{
84 struct spi_transfer t[3];
85 struct spi_message m;
86 __le16 addr;
87
88
89 addr = cpu_to_le16(address << 8);
90
91 spi_message_init(&m);
92 memset(t, 0, sizeof(t));
93
94 t[0].tx_buf = &addr;
95 t[0].len = sizeof(addr);
96 spi_message_add_tail(&t[0], &m);
97
98 t[1].tx_buf = buf;
99 t[1].len = len & ~1;
100 spi_message_add_tail(&t[1], &m);
101
102 if (len % 2) {
103 __le16 last_word;
104 last_word = cpu_to_le16(((u8 *)buf)[len - 1]);
105
106 t[2].tx_buf = &last_word;
107 t[2].len = sizeof(last_word);
108 spi_message_add_tail(&t[2], &m);
109 }
110
111 spi_sync(priv->spi, &m);
112}
113
114static u32 p54spi_read32(struct p54s_priv *priv, u8 addr)
115{
116 __le32 val;
117
118 p54spi_spi_read(priv, addr, &val, sizeof(val));
119
120 return le32_to_cpu(val);
121}
122
123static inline void p54spi_write16(struct p54s_priv *priv, u8 addr, __le16 val)
124{
125 p54spi_spi_write(priv, addr, &val, sizeof(val));
126}
127
128static inline void p54spi_write32(struct p54s_priv *priv, u8 addr, __le32 val)
129{
130 p54spi_spi_write(priv, addr, &val, sizeof(val));
131}
132
133static int p54spi_wait_bit(struct p54s_priv *priv, u16 reg, u32 bits)
134{
135 int i;
136
137 for (i = 0; i < 2000; i++) {
138 u32 buffer = p54spi_read32(priv, reg);
139 if ((buffer & bits) == bits)
140 return 1;
141 }
142 return 0;
143}
144
145static int p54spi_spi_write_dma(struct p54s_priv *priv, __le32 base,
146 const void *buf, size_t len)
147{
148 if (!p54spi_wait_bit(priv, SPI_ADRS_DMA_WRITE_CTRL, HOST_ALLOWED)) {
149 dev_err(&priv->spi->dev, "spi_write_dma not allowed "
150 "to DMA write.\n");
151 return -EAGAIN;
152 }
153
154 p54spi_write16(priv, SPI_ADRS_DMA_WRITE_CTRL,
155 cpu_to_le16(SPI_DMA_WRITE_CTRL_ENABLE));
156
157 p54spi_write16(priv, SPI_ADRS_DMA_WRITE_LEN, cpu_to_le16(len));
158 p54spi_write32(priv, SPI_ADRS_DMA_WRITE_BASE, base);
159 p54spi_spi_write(priv, SPI_ADRS_DMA_DATA, buf, len);
160 return 0;
161}
162
163static int p54spi_request_firmware(struct ieee80211_hw *dev)
164{
165 struct p54s_priv *priv = dev->priv;
166 int ret;
167
168
169 ret = request_firmware(&priv->firmware, "3826.arm", &priv->spi->dev);
170
171 if (ret < 0) {
172 dev_err(&priv->spi->dev, "request_firmware() failed: %d", ret);
173 return ret;
174 }
175
176 ret = p54_parse_firmware(dev, priv->firmware);
177 if (ret) {
178 release_firmware(priv->firmware);
179 return ret;
180 }
181
182 return 0;
183}
184
185static int p54spi_request_eeprom(struct ieee80211_hw *dev)
186{
187 struct p54s_priv *priv = dev->priv;
188 const struct firmware *eeprom;
189 int ret;
190
191
192
193
194
195 ret = request_firmware(&eeprom, "3826.eeprom", &priv->spi->dev);
196 if (ret < 0) {
197 dev_info(&priv->spi->dev, "loading default eeprom...\n");
198 ret = p54_parse_eeprom(dev, (void *) p54spi_eeprom,
199 sizeof(p54spi_eeprom));
200 } else {
201 dev_info(&priv->spi->dev, "loading user eeprom...\n");
202 ret = p54_parse_eeprom(dev, (void *) eeprom->data,
203 (int)eeprom->size);
204 release_firmware(eeprom);
205 }
206 return ret;
207}
208
209static int p54spi_upload_firmware(struct ieee80211_hw *dev)
210{
211 struct p54s_priv *priv = dev->priv;
212 unsigned long fw_len, _fw_len;
213 unsigned int offset = 0;
214 int err = 0;
215 u8 *fw;
216
217 fw_len = priv->firmware->size;
218 fw = kmemdup(priv->firmware->data, fw_len, GFP_KERNEL);
219 if (!fw)
220 return -ENOMEM;
221
222
223 p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
224 SPI_CTRL_STAT_HOST_OVERRIDE | SPI_CTRL_STAT_HOST_RESET |
225 SPI_CTRL_STAT_START_HALTED));
226
227 msleep(TARGET_BOOT_SLEEP);
228
229 p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
230 SPI_CTRL_STAT_HOST_OVERRIDE |
231 SPI_CTRL_STAT_START_HALTED));
232
233 msleep(TARGET_BOOT_SLEEP);
234
235 while (fw_len > 0) {
236 _fw_len = min_t(long, fw_len, SPI_MAX_PACKET_SIZE);
237
238 err = p54spi_spi_write_dma(priv, cpu_to_le32(
239 ISL38XX_DEV_FIRMWARE_ADDR + offset),
240 (fw + offset), _fw_len);
241 if (err < 0)
242 goto out;
243
244 fw_len -= _fw_len;
245 offset += _fw_len;
246 }
247
248 BUG_ON(fw_len != 0);
249
250
251 p54spi_write32(priv, SPI_ADRS_HOST_INT_EN,
252 cpu_to_le32(SPI_HOST_INTS_DEFAULT));
253
254
255 p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
256 SPI_CTRL_STAT_HOST_OVERRIDE | SPI_CTRL_STAT_HOST_RESET |
257 SPI_CTRL_STAT_RAM_BOOT));
258
259 msleep(TARGET_BOOT_SLEEP);
260
261 p54spi_write16(priv, SPI_ADRS_DEV_CTRL_STAT, cpu_to_le16(
262 SPI_CTRL_STAT_HOST_OVERRIDE | SPI_CTRL_STAT_RAM_BOOT));
263 msleep(TARGET_BOOT_SLEEP);
264
265out:
266 kfree(fw);
267 return err;
268}
269
270static void p54spi_power_off(struct p54s_priv *priv)
271{
272 disable_irq(gpio_to_irq(p54spi_gpio_irq));
273 gpio_set_value(p54spi_gpio_power, 0);
274}
275
276static void p54spi_power_on(struct p54s_priv *priv)
277{
278 gpio_set_value(p54spi_gpio_power, 1);
279 enable_irq(gpio_to_irq(p54spi_gpio_irq));
280
281
282
283
284
285 msleep(10);
286}
287
288static inline void p54spi_int_ack(struct p54s_priv *priv, u32 val)
289{
290 p54spi_write32(priv, SPI_ADRS_HOST_INT_ACK, cpu_to_le32(val));
291}
292
293static int p54spi_wakeup(struct p54s_priv *priv)
294{
295
296 p54spi_write32(priv, SPI_ADRS_ARM_INTERRUPTS,
297 cpu_to_le32(SPI_TARGET_INT_WAKEUP));
298
299
300 if (!p54spi_wait_bit(priv, SPI_ADRS_HOST_INTERRUPTS,
301 SPI_HOST_INT_READY)) {
302 dev_err(&priv->spi->dev, "INT_READY timeout\n");
303 return -EBUSY;
304 }
305
306 p54spi_int_ack(priv, SPI_HOST_INT_READY);
307 return 0;
308}
309
310static inline void p54spi_sleep(struct p54s_priv *priv)
311{
312 p54spi_write32(priv, SPI_ADRS_ARM_INTERRUPTS,
313 cpu_to_le32(SPI_TARGET_INT_SLEEP));
314}
315
316static void p54spi_int_ready(struct p54s_priv *priv)
317{
318 p54spi_write32(priv, SPI_ADRS_HOST_INT_EN, cpu_to_le32(
319 SPI_HOST_INT_UPDATE | SPI_HOST_INT_SW_UPDATE));
320
321 switch (priv->fw_state) {
322 case FW_STATE_BOOTING:
323 priv->fw_state = FW_STATE_READY;
324 complete(&priv->fw_comp);
325 break;
326 case FW_STATE_RESETTING:
327 priv->fw_state = FW_STATE_READY;
328
329 break;
330 default:
331 break;
332 }
333}
334
335static int p54spi_rx(struct p54s_priv *priv)
336{
337 struct sk_buff *skb;
338 u16 len;
339 u16 rx_head[2];
340#define READAHEAD_SZ (sizeof(rx_head)-sizeof(u16))
341
342 if (p54spi_wakeup(priv) < 0)
343 return -EBUSY;
344
345
346
347
348
349 p54spi_spi_read(priv, SPI_ADRS_DMA_DATA, rx_head, sizeof(rx_head));
350 len = rx_head[0];
351
352 if (len == 0) {
353 p54spi_sleep(priv);
354 dev_err(&priv->spi->dev, "rx request of zero bytes\n");
355 return 0;
356 }
357
358
359
360
361
362 skb = dev_alloc_skb(len + 4);
363 if (!skb) {
364 p54spi_sleep(priv);
365 dev_err(&priv->spi->dev, "could not alloc skb");
366 return -ENOMEM;
367 }
368
369 if (len <= READAHEAD_SZ) {
370 memcpy(skb_put(skb, len), rx_head + 1, len);
371 } else {
372 memcpy(skb_put(skb, READAHEAD_SZ), rx_head + 1, READAHEAD_SZ);
373 p54spi_spi_read(priv, SPI_ADRS_DMA_DATA,
374 skb_put(skb, len - READAHEAD_SZ),
375 len - READAHEAD_SZ);
376 }
377 p54spi_sleep(priv);
378
379
380 skb_put(skb, 4);
381
382 if (p54_rx(priv->hw, skb) == 0)
383 dev_kfree_skb(skb);
384
385 return 0;
386}
387
388
389static irqreturn_t p54spi_interrupt(int irq, void *config)
390{
391 struct spi_device *spi = config;
392 struct p54s_priv *priv = dev_get_drvdata(&spi->dev);
393
394 ieee80211_queue_work(priv->hw, &priv->work);
395
396 return IRQ_HANDLED;
397}
398
399static int p54spi_tx_frame(struct p54s_priv *priv, struct sk_buff *skb)
400{
401 struct p54_hdr *hdr = (struct p54_hdr *) skb->data;
402 int ret = 0;
403
404 if (p54spi_wakeup(priv) < 0)
405 return -EBUSY;
406
407 ret = p54spi_spi_write_dma(priv, hdr->req_id, skb->data, skb->len);
408 if (ret < 0)
409 goto out;
410
411 if (!p54spi_wait_bit(priv, SPI_ADRS_HOST_INTERRUPTS,
412 SPI_HOST_INT_WR_READY)) {
413 dev_err(&priv->spi->dev, "WR_READY timeout\n");
414 ret = -EAGAIN;
415 goto out;
416 }
417
418 p54spi_int_ack(priv, SPI_HOST_INT_WR_READY);
419
420 if (FREE_AFTER_TX(skb))
421 p54_free_skb(priv->hw, skb);
422out:
423 p54spi_sleep(priv);
424 return ret;
425}
426
427static int p54spi_wq_tx(struct p54s_priv *priv)
428{
429 struct p54s_tx_info *entry;
430 struct sk_buff *skb;
431 struct ieee80211_tx_info *info;
432 struct p54_tx_info *minfo;
433 struct p54s_tx_info *dinfo;
434 unsigned long flags;
435 int ret = 0;
436
437 spin_lock_irqsave(&priv->tx_lock, flags);
438
439 while (!list_empty(&priv->tx_pending)) {
440 entry = list_entry(priv->tx_pending.next,
441 struct p54s_tx_info, tx_list);
442
443 list_del_init(&entry->tx_list);
444
445 spin_unlock_irqrestore(&priv->tx_lock, flags);
446
447 dinfo = container_of((void *) entry, struct p54s_tx_info,
448 tx_list);
449 minfo = container_of((void *) dinfo, struct p54_tx_info,
450 data);
451 info = container_of((void *) minfo, struct ieee80211_tx_info,
452 rate_driver_data);
453 skb = container_of((void *) info, struct sk_buff, cb);
454
455 ret = p54spi_tx_frame(priv, skb);
456
457 if (ret < 0) {
458 p54_free_skb(priv->hw, skb);
459 return ret;
460 }
461
462 spin_lock_irqsave(&priv->tx_lock, flags);
463 }
464 spin_unlock_irqrestore(&priv->tx_lock, flags);
465 return ret;
466}
467
468static void p54spi_op_tx(struct ieee80211_hw *dev, struct sk_buff *skb)
469{
470 struct p54s_priv *priv = dev->priv;
471 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
472 struct p54_tx_info *mi = (struct p54_tx_info *) info->rate_driver_data;
473 struct p54s_tx_info *di = (struct p54s_tx_info *) mi->data;
474 unsigned long flags;
475
476 BUILD_BUG_ON(sizeof(*di) > sizeof((mi->data)));
477
478 spin_lock_irqsave(&priv->tx_lock, flags);
479 list_add_tail(&di->tx_list, &priv->tx_pending);
480 spin_unlock_irqrestore(&priv->tx_lock, flags);
481
482 ieee80211_queue_work(priv->hw, &priv->work);
483}
484
485static void p54spi_work(struct work_struct *work)
486{
487 struct p54s_priv *priv = container_of(work, struct p54s_priv, work);
488 u32 ints;
489 int ret;
490
491 mutex_lock(&priv->mutex);
492
493 if (priv->fw_state == FW_STATE_OFF)
494 goto out;
495
496 ints = p54spi_read32(priv, SPI_ADRS_HOST_INTERRUPTS);
497
498 if (ints & SPI_HOST_INT_READY) {
499 p54spi_int_ready(priv);
500 p54spi_int_ack(priv, SPI_HOST_INT_READY);
501 }
502
503 if (priv->fw_state != FW_STATE_READY)
504 goto out;
505
506 if (ints & SPI_HOST_INT_UPDATE) {
507 p54spi_int_ack(priv, SPI_HOST_INT_UPDATE);
508 ret = p54spi_rx(priv);
509 if (ret < 0)
510 goto out;
511 }
512 if (ints & SPI_HOST_INT_SW_UPDATE) {
513 p54spi_int_ack(priv, SPI_HOST_INT_SW_UPDATE);
514 ret = p54spi_rx(priv);
515 if (ret < 0)
516 goto out;
517 }
518
519 ret = p54spi_wq_tx(priv);
520out:
521 mutex_unlock(&priv->mutex);
522}
523
524static int p54spi_op_start(struct ieee80211_hw *dev)
525{
526 struct p54s_priv *priv = dev->priv;
527 unsigned long timeout;
528 int ret = 0;
529
530 if (mutex_lock_interruptible(&priv->mutex)) {
531 ret = -EINTR;
532 goto out;
533 }
534
535 priv->fw_state = FW_STATE_BOOTING;
536
537 p54spi_power_on(priv);
538
539 ret = p54spi_upload_firmware(dev);
540 if (ret < 0) {
541 p54spi_power_off(priv);
542 goto out_unlock;
543 }
544
545 mutex_unlock(&priv->mutex);
546
547 timeout = msecs_to_jiffies(2000);
548 timeout = wait_for_completion_interruptible_timeout(&priv->fw_comp,
549 timeout);
550 if (!timeout) {
551 dev_err(&priv->spi->dev, "firmware boot failed");
552 p54spi_power_off(priv);
553 ret = -1;
554 goto out;
555 }
556
557 if (mutex_lock_interruptible(&priv->mutex)) {
558 ret = -EINTR;
559 p54spi_power_off(priv);
560 goto out;
561 }
562
563 WARN_ON(priv->fw_state != FW_STATE_READY);
564
565out_unlock:
566 mutex_unlock(&priv->mutex);
567
568out:
569 return ret;
570}
571
572static void p54spi_op_stop(struct ieee80211_hw *dev)
573{
574 struct p54s_priv *priv = dev->priv;
575 unsigned long flags;
576
577 if (mutex_lock_interruptible(&priv->mutex)) {
578
579 return;
580 }
581
582 WARN_ON(priv->fw_state != FW_STATE_READY);
583
584 cancel_work_sync(&priv->work);
585
586 p54spi_power_off(priv);
587 spin_lock_irqsave(&priv->tx_lock, flags);
588 INIT_LIST_HEAD(&priv->tx_pending);
589 spin_unlock_irqrestore(&priv->tx_lock, flags);
590
591 priv->fw_state = FW_STATE_OFF;
592 mutex_unlock(&priv->mutex);
593}
594
595static int __devinit p54spi_probe(struct spi_device *spi)
596{
597 struct p54s_priv *priv = NULL;
598 struct ieee80211_hw *hw;
599 int ret = -EINVAL;
600
601 hw = p54_init_common(sizeof(*priv));
602 if (!hw) {
603 dev_err(&spi->dev, "could not alloc ieee80211_hw");
604 return -ENOMEM;
605 }
606
607 priv = hw->priv;
608 priv->hw = hw;
609 dev_set_drvdata(&spi->dev, priv);
610 priv->spi = spi;
611
612 spi->bits_per_word = 16;
613 spi->max_speed_hz = 24000000;
614
615 ret = spi_setup(spi);
616 if (ret < 0) {
617 dev_err(&priv->spi->dev, "spi_setup failed");
618 goto err_free_common;
619 }
620
621 ret = gpio_request(p54spi_gpio_power, "p54spi power");
622 if (ret < 0) {
623 dev_err(&priv->spi->dev, "power GPIO request failed: %d", ret);
624 goto err_free_common;
625 }
626
627 ret = gpio_request(p54spi_gpio_irq, "p54spi irq");
628 if (ret < 0) {
629 dev_err(&priv->spi->dev, "irq GPIO request failed: %d", ret);
630 goto err_free_common;
631 }
632
633 gpio_direction_output(p54spi_gpio_power, 0);
634 gpio_direction_input(p54spi_gpio_irq);
635
636 ret = request_irq(gpio_to_irq(p54spi_gpio_irq),
637 p54spi_interrupt, IRQF_DISABLED, "p54spi",
638 priv->spi);
639 if (ret < 0) {
640 dev_err(&priv->spi->dev, "request_irq() failed");
641 goto err_free_common;
642 }
643
644 set_irq_type(gpio_to_irq(p54spi_gpio_irq),
645 IRQ_TYPE_EDGE_RISING);
646
647 disable_irq(gpio_to_irq(p54spi_gpio_irq));
648
649 INIT_WORK(&priv->work, p54spi_work);
650 init_completion(&priv->fw_comp);
651 INIT_LIST_HEAD(&priv->tx_pending);
652 mutex_init(&priv->mutex);
653 SET_IEEE80211_DEV(hw, &spi->dev);
654 priv->common.open = p54spi_op_start;
655 priv->common.stop = p54spi_op_stop;
656 priv->common.tx = p54spi_op_tx;
657
658 ret = p54spi_request_firmware(hw);
659 if (ret < 0)
660 goto err_free_common;
661
662 ret = p54spi_request_eeprom(hw);
663 if (ret)
664 goto err_free_common;
665
666 ret = p54_register_common(hw, &priv->spi->dev);
667 if (ret)
668 goto err_free_common;
669
670 return 0;
671
672err_free_common:
673 p54_free_common(priv->hw);
674 return ret;
675}
676
677static int __devexit p54spi_remove(struct spi_device *spi)
678{
679 struct p54s_priv *priv = dev_get_drvdata(&spi->dev);
680
681 p54_unregister_common(priv->hw);
682
683 free_irq(gpio_to_irq(p54spi_gpio_irq), spi);
684
685 gpio_free(p54spi_gpio_power);
686 gpio_free(p54spi_gpio_irq);
687 release_firmware(priv->firmware);
688
689 mutex_destroy(&priv->mutex);
690
691 p54_free_common(priv->hw);
692
693 return 0;
694}
695
696
697static struct spi_driver p54spi_driver = {
698 .driver = {
699
700
701 .name = "cx3110x",
702 .bus = &spi_bus_type,
703 .owner = THIS_MODULE,
704 },
705
706 .probe = p54spi_probe,
707 .remove = __devexit_p(p54spi_remove),
708};
709
710static int __init p54spi_init(void)
711{
712 int ret;
713
714 ret = spi_register_driver(&p54spi_driver);
715 if (ret < 0) {
716 printk(KERN_ERR "failed to register SPI driver: %d", ret);
717 goto out;
718 }
719
720out:
721 return ret;
722}
723
724static void __exit p54spi_exit(void)
725{
726 spi_unregister_driver(&p54spi_driver);
727}
728
729module_init(p54spi_init);
730module_exit(p54spi_exit);
731
732MODULE_LICENSE("GPL");
733MODULE_AUTHOR("Christian Lamparter <chunkeey@web.de>");
734MODULE_ALIAS("spi:cx3110x");
735
