38bf7cf2256d04f7c15dd655be706e3c3b779c94
[linux-2.6.git] / drivers / net / irda / sa1100_ir.c
1 /*
2  *  linux/drivers/net/irda/sa1100_ir.c
3  *
4  *  Copyright (C) 2000-2001 Russell King
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  *
10  *  Infra-red driver for the StrongARM SA1100 embedded microprocessor
11  *
12  *  Note that we don't have to worry about the SA1111's DMA bugs in here,
13  *  so we use the straight forward dma_map_* functions with a null pointer.
14  *
15  *  This driver takes one kernel command line parameter, sa1100ir=, with
16  *  the following options:
17  *      max_rate:baudrate       - set the maximum baud rate
18  *      power_leve:level        - set the transmitter power level
19  *      tx_lpm:0|1              - set transmit low power mode
20  */
21 #include <linux/module.h>
22 #include <linux/moduleparam.h>
23 #include <linux/types.h>
24 #include <linux/init.h>
25 #include <linux/errno.h>
26 #include <linux/netdevice.h>
27 #include <linux/slab.h>
28 #include <linux/rtnetlink.h>
29 #include <linux/interrupt.h>
30 #include <linux/delay.h>
31 #include <linux/platform_device.h>
32 #include <linux/dma-mapping.h>
33
34 #include <net/irda/irda.h>
35 #include <net/irda/wrapper.h>
36 #include <net/irda/irda_device.h>
37
38 #include <asm/irq.h>
39 #include <mach/dma.h>
40 #include <mach/hardware.h>
41 #include <asm/mach/irda.h>
42
43 static int power_level = 3;
44 static int tx_lpm;
45 static int max_rate = 4000000;
46
47 struct sa1100_irda {
48         unsigned char           hscr0;
49         unsigned char           utcr4;
50         unsigned char           power;
51         unsigned char           open;
52
53         int                     speed;
54         int                     newspeed;
55
56         struct sk_buff          *txskb;
57         struct sk_buff          *rxskb;
58         dma_addr_t              txbuf_dma;
59         dma_addr_t              rxbuf_dma;
60         dma_regs_t              *txdma;
61         dma_regs_t              *rxdma;
62
63         struct device           *dev;
64         struct irda_platform_data *pdata;
65         struct irlap_cb         *irlap;
66         struct qos_info         qos;
67
68         iobuff_t                tx_buff;
69         iobuff_t                rx_buff;
70 };
71
72 #define IS_FIR(si)              ((si)->speed >= 4000000)
73
74 #define HPSIR_MAX_RXLEN         2047
75
76 /*
77  * Allocate and map the receive buffer, unless it is already allocated.
78  */
79 static int sa1100_irda_rx_alloc(struct sa1100_irda *si)
80 {
81         if (si->rxskb)
82                 return 0;
83
84         si->rxskb = alloc_skb(HPSIR_MAX_RXLEN + 1, GFP_ATOMIC);
85
86         if (!si->rxskb) {
87                 printk(KERN_ERR "sa1100_ir: out of memory for RX SKB\n");
88                 return -ENOMEM;
89         }
90
91         /*
92          * Align any IP headers that may be contained
93          * within the frame.
94          */
95         skb_reserve(si->rxskb, 1);
96
97         si->rxbuf_dma = dma_map_single(si->dev, si->rxskb->data,
98                                         HPSIR_MAX_RXLEN,
99                                         DMA_FROM_DEVICE);
100         return 0;
101 }
102
103 /*
104  * We want to get here as soon as possible, and get the receiver setup.
105  * We use the existing buffer.
106  */
107 static void sa1100_irda_rx_dma_start(struct sa1100_irda *si)
108 {
109         if (!si->rxskb) {
110                 printk(KERN_ERR "sa1100_ir: rx buffer went missing\n");
111                 return;
112         }
113
114         /*
115          * First empty receive FIFO
116          */
117         Ser2HSCR0 = si->hscr0 | HSCR0_HSSP;
118
119         /*
120          * Enable the DMA, receiver and receive interrupt.
121          */
122         sa1100_clear_dma(si->rxdma);
123         sa1100_start_dma(si->rxdma, si->rxbuf_dma, HPSIR_MAX_RXLEN);
124         Ser2HSCR0 = si->hscr0 | HSCR0_HSSP | HSCR0_RXE;
125 }
126
127 /*
128  * Set the IrDA communications speed.
129  */
130 static int sa1100_irda_set_speed(struct sa1100_irda *si, int speed)
131 {
132         unsigned long flags;
133         int brd, ret = -EINVAL;
134
135         switch (speed) {
136         case 9600:      case 19200:     case 38400:
137         case 57600:     case 115200:
138                 brd = 3686400 / (16 * speed) - 1;
139
140                 /*
141                  * Stop the receive DMA.
142                  */
143                 if (IS_FIR(si))
144                         sa1100_stop_dma(si->rxdma);
145
146                 local_irq_save(flags);
147
148                 Ser2UTCR3 = 0;
149                 Ser2HSCR0 = HSCR0_UART;
150
151                 Ser2UTCR1 = brd >> 8;
152                 Ser2UTCR2 = brd;
153
154                 /*
155                  * Clear status register
156                  */
157                 Ser2UTSR0 = UTSR0_REB | UTSR0_RBB | UTSR0_RID;
158                 Ser2UTCR3 = UTCR3_RIE | UTCR3_RXE | UTCR3_TXE;
159
160                 if (si->pdata->set_speed)
161                         si->pdata->set_speed(si->dev, speed);
162
163                 si->speed = speed;
164
165                 local_irq_restore(flags);
166                 ret = 0;
167                 break;
168
169         case 4000000:
170                 local_irq_save(flags);
171
172                 si->hscr0 = 0;
173
174                 Ser2HSSR0 = 0xff;
175                 Ser2HSCR0 = si->hscr0 | HSCR0_HSSP;
176                 Ser2UTCR3 = 0;
177
178                 si->speed = speed;
179
180                 if (si->pdata->set_speed)
181                         si->pdata->set_speed(si->dev, speed);
182
183                 sa1100_irda_rx_alloc(si);
184                 sa1100_irda_rx_dma_start(si);
185
186                 local_irq_restore(flags);
187
188                 break;
189
190         default:
191                 break;
192         }
193
194         return ret;
195 }
196
197 /*
198  * Control the power state of the IrDA transmitter.
199  * State:
200  *  0 - off
201  *  1 - short range, lowest power
202  *  2 - medium range, medium power
203  *  3 - maximum range, high power
204  *
205  * Currently, only assabet is known to support this.
206  */
207 static int
208 __sa1100_irda_set_power(struct sa1100_irda *si, unsigned int state)
209 {
210         int ret = 0;
211         if (si->pdata->set_power)
212                 ret = si->pdata->set_power(si->dev, state);
213         return ret;
214 }
215
216 static inline int
217 sa1100_set_power(struct sa1100_irda *si, unsigned int state)
218 {
219         int ret;
220
221         ret = __sa1100_irda_set_power(si, state);
222         if (ret == 0)
223                 si->power = state;
224
225         return ret;
226 }
227
228 static int sa1100_irda_startup(struct sa1100_irda *si)
229 {
230         int ret;
231
232         /*
233          * Ensure that the ports for this device are setup correctly.
234          */
235         if (si->pdata->startup)
236                 si->pdata->startup(si->dev);
237
238         /*
239          * Configure PPC for IRDA - we want to drive TXD2 low.
240          * We also want to drive this pin low during sleep.
241          */
242         PPSR &= ~PPC_TXD2;
243         PSDR &= ~PPC_TXD2;
244         PPDR |= PPC_TXD2;
245
246         /*
247          * Enable HP-SIR modulation, and ensure that the port is disabled.
248          */
249         Ser2UTCR3 = 0;
250         Ser2HSCR0 = HSCR0_UART;
251         Ser2UTCR4 = si->utcr4;
252         Ser2UTCR0 = UTCR0_8BitData;
253         Ser2HSCR2 = HSCR2_TrDataH | HSCR2_RcDataL;
254
255         /*
256          * Clear status register
257          */
258         Ser2UTSR0 = UTSR0_REB | UTSR0_RBB | UTSR0_RID;
259
260         ret = sa1100_irda_set_speed(si, si->speed = 9600);
261         if (ret) {
262                 Ser2UTCR3 = 0;
263                 Ser2HSCR0 = 0;
264
265                 if (si->pdata->shutdown)
266                         si->pdata->shutdown(si->dev);
267         }
268
269         return ret;
270 }
271
272 static void sa1100_irda_shutdown(struct sa1100_irda *si)
273 {
274         /*
275          * Stop all DMA activity.
276          */
277         sa1100_stop_dma(si->rxdma);
278         sa1100_stop_dma(si->txdma);
279
280         /* Disable the port. */
281         Ser2UTCR3 = 0;
282         Ser2HSCR0 = 0;
283
284         if (si->pdata->shutdown)
285                 si->pdata->shutdown(si->dev);
286 }
287
288 #ifdef CONFIG_PM
289 /*
290  * Suspend the IrDA interface.
291  */
292 static int sa1100_irda_suspend(struct platform_device *pdev, pm_message_t state)
293 {
294         struct net_device *dev = platform_get_drvdata(pdev);
295         struct sa1100_irda *si;
296
297         if (!dev)
298                 return 0;
299
300         si = netdev_priv(dev);
301         if (si->open) {
302                 /*
303                  * Stop the transmit queue
304                  */
305                 netif_device_detach(dev);
306                 disable_irq(dev->irq);
307                 sa1100_irda_shutdown(si);
308                 __sa1100_irda_set_power(si, 0);
309         }
310
311         return 0;
312 }
313
314 /*
315  * Resume the IrDA interface.
316  */
317 static int sa1100_irda_resume(struct platform_device *pdev)
318 {
319         struct net_device *dev = platform_get_drvdata(pdev);
320         struct sa1100_irda *si;
321
322         if (!dev)
323                 return 0;
324
325         si = netdev_priv(dev);
326         if (si->open) {
327                 /*
328                  * If we missed a speed change, initialise at the new speed
329                  * directly.  It is debatable whether this is actually
330                  * required, but in the interests of continuing from where
331                  * we left off it is desireable.  The converse argument is
332                  * that we should re-negotiate at 9600 baud again.
333                  */
334                 if (si->newspeed) {
335                         si->speed = si->newspeed;
336                         si->newspeed = 0;
337                 }
338
339                 sa1100_irda_startup(si);
340                 __sa1100_irda_set_power(si, si->power);
341                 enable_irq(dev->irq);
342
343                 /*
344                  * This automatically wakes up the queue
345                  */
346                 netif_device_attach(dev);
347         }
348
349         return 0;
350 }
351 #else
352 #define sa1100_irda_suspend     NULL
353 #define sa1100_irda_resume      NULL
354 #endif
355
356 /*
357  * HP-SIR format interrupt service routines.
358  */
359 static void sa1100_irda_hpsir_irq(struct net_device *dev)
360 {
361         struct sa1100_irda *si = netdev_priv(dev);
362         int status;
363
364         status = Ser2UTSR0;
365
366         /*
367          * Deal with any receive errors first.  The bytes in error may be
368          * the only bytes in the receive FIFO, so we do this first.
369          */
370         while (status & UTSR0_EIF) {
371                 int stat, data;
372
373                 stat = Ser2UTSR1;
374                 data = Ser2UTDR;
375
376                 if (stat & (UTSR1_FRE | UTSR1_ROR)) {
377                         dev->stats.rx_errors++;
378                         if (stat & UTSR1_FRE)
379                                 dev->stats.rx_frame_errors++;
380                         if (stat & UTSR1_ROR)
381                                 dev->stats.rx_fifo_errors++;
382                 } else
383                         async_unwrap_char(dev, &dev->stats, &si->rx_buff, data);
384
385                 status = Ser2UTSR0;
386         }
387
388         /*
389          * We must clear certain bits.
390          */
391         Ser2UTSR0 = status & (UTSR0_RID | UTSR0_RBB | UTSR0_REB);
392
393         if (status & UTSR0_RFS) {
394                 /*
395                  * There are at least 4 bytes in the FIFO.  Read 3 bytes
396                  * and leave the rest to the block below.
397                  */
398                 async_unwrap_char(dev, &dev->stats, &si->rx_buff, Ser2UTDR);
399                 async_unwrap_char(dev, &dev->stats, &si->rx_buff, Ser2UTDR);
400                 async_unwrap_char(dev, &dev->stats, &si->rx_buff, Ser2UTDR);
401         }
402
403         if (status & (UTSR0_RFS | UTSR0_RID)) {
404                 /*
405                  * Fifo contains more than 1 character.
406                  */
407                 do {
408                         async_unwrap_char(dev, &dev->stats, &si->rx_buff,
409                                           Ser2UTDR);
410                 } while (Ser2UTSR1 & UTSR1_RNE);
411
412         }
413
414         if (status & UTSR0_TFS && si->tx_buff.len) {
415                 /*
416                  * Transmitter FIFO is not full
417                  */
418                 do {
419                         Ser2UTDR = *si->tx_buff.data++;
420                         si->tx_buff.len -= 1;
421                 } while (Ser2UTSR1 & UTSR1_TNF && si->tx_buff.len);
422
423                 if (si->tx_buff.len == 0) {
424                         dev->stats.tx_packets++;
425                         dev->stats.tx_bytes += si->tx_buff.data -
426                                               si->tx_buff.head;
427
428                         /*
429                          * We need to ensure that the transmitter has
430                          * finished.
431                          */
432                         do
433                                 rmb();
434                         while (Ser2UTSR1 & UTSR1_TBY);
435
436                         /*
437                          * Ok, we've finished transmitting.  Now enable
438                          * the receiver.  Sometimes we get a receive IRQ
439                          * immediately after a transmit...
440                          */
441                         Ser2UTSR0 = UTSR0_REB | UTSR0_RBB | UTSR0_RID;
442                         Ser2UTCR3 = UTCR3_RIE | UTCR3_RXE | UTCR3_TXE;
443
444                         if (si->newspeed) {
445                                 sa1100_irda_set_speed(si, si->newspeed);
446                                 si->newspeed = 0;
447                         }
448
449                         /* I'm hungry! */
450                         netif_wake_queue(dev);
451                 }
452         }
453 }
454
455 static void sa1100_irda_fir_error(struct sa1100_irda *si, struct net_device *dev)
456 {
457         struct sk_buff *skb = si->rxskb;
458         dma_addr_t dma_addr;
459         unsigned int len, stat, data;
460
461         if (!skb) {
462                 printk(KERN_ERR "sa1100_ir: SKB is NULL!\n");
463                 return;
464         }
465
466         /*
467          * Get the current data position.
468          */
469         dma_addr = sa1100_get_dma_pos(si->rxdma);
470         len = dma_addr - si->rxbuf_dma;
471         if (len > HPSIR_MAX_RXLEN)
472                 len = HPSIR_MAX_RXLEN;
473         dma_unmap_single(si->dev, si->rxbuf_dma, len, DMA_FROM_DEVICE);
474
475         do {
476                 /*
477                  * Read Status, and then Data.
478                  */
479                 stat = Ser2HSSR1;
480                 rmb();
481                 data = Ser2HSDR;
482
483                 if (stat & (HSSR1_CRE | HSSR1_ROR)) {
484                         dev->stats.rx_errors++;
485                         if (stat & HSSR1_CRE)
486                                 dev->stats.rx_crc_errors++;
487                         if (stat & HSSR1_ROR)
488                                 dev->stats.rx_frame_errors++;
489                 } else
490                         skb->data[len++] = data;
491
492                 /*
493                  * If we hit the end of frame, there's
494                  * no point in continuing.
495                  */
496                 if (stat & HSSR1_EOF)
497                         break;
498         } while (Ser2HSSR0 & HSSR0_EIF);
499
500         if (stat & HSSR1_EOF) {
501                 si->rxskb = NULL;
502
503                 skb_put(skb, len);
504                 skb->dev = dev;
505                 skb_reset_mac_header(skb);
506                 skb->protocol = htons(ETH_P_IRDA);
507                 dev->stats.rx_packets++;
508                 dev->stats.rx_bytes += len;
509
510                 /*
511                  * Before we pass the buffer up, allocate a new one.
512                  */
513                 sa1100_irda_rx_alloc(si);
514
515                 netif_rx(skb);
516         } else {
517                 /*
518                  * Remap the buffer.
519                  */
520                 si->rxbuf_dma = dma_map_single(si->dev, si->rxskb->data,
521                                                 HPSIR_MAX_RXLEN,
522                                                 DMA_FROM_DEVICE);
523         }
524 }
525
526 /*
527  * FIR format interrupt service routine.  We only have to
528  * handle RX events; transmit events go via the TX DMA handler.
529  *
530  * No matter what, we disable RX, process, and the restart RX.
531  */
532 static void sa1100_irda_fir_irq(struct net_device *dev)
533 {
534         struct sa1100_irda *si = netdev_priv(dev);
535
536         /*
537          * Stop RX DMA
538          */
539         sa1100_stop_dma(si->rxdma);
540
541         /*
542          * Framing error - we throw away the packet completely.
543          * Clearing RXE flushes the error conditions and data
544          * from the fifo.
545          */
546         if (Ser2HSSR0 & (HSSR0_FRE | HSSR0_RAB)) {
547                 dev->stats.rx_errors++;
548
549                 if (Ser2HSSR0 & HSSR0_FRE)
550                         dev->stats.rx_frame_errors++;
551
552                 /*
553                  * Clear out the DMA...
554                  */
555                 Ser2HSCR0 = si->hscr0 | HSCR0_HSSP;
556
557                 /*
558                  * Clear selected status bits now, so we
559                  * don't miss them next time around.
560                  */
561                 Ser2HSSR0 = HSSR0_FRE | HSSR0_RAB;
562         }
563
564         /*
565          * Deal with any receive errors.  The any of the lowest
566          * 8 bytes in the FIFO may contain an error.  We must read
567          * them one by one.  The "error" could even be the end of
568          * packet!
569          */
570         if (Ser2HSSR0 & HSSR0_EIF)
571                 sa1100_irda_fir_error(si, dev);
572
573         /*
574          * No matter what happens, we must restart reception.
575          */
576         sa1100_irda_rx_dma_start(si);
577 }
578
579 static irqreturn_t sa1100_irda_irq(int irq, void *dev_id)
580 {
581         struct net_device *dev = dev_id;
582         if (IS_FIR(((struct sa1100_irda *)netdev_priv(dev))))
583                 sa1100_irda_fir_irq(dev);
584         else
585                 sa1100_irda_hpsir_irq(dev);
586         return IRQ_HANDLED;
587 }
588
589 /*
590  * TX DMA completion handler.
591  */
592 static void sa1100_irda_txdma_irq(void *id)
593 {
594         struct net_device *dev = id;
595         struct sa1100_irda *si = netdev_priv(dev);
596         struct sk_buff *skb = si->txskb;
597
598         si->txskb = NULL;
599
600         /*
601          * Wait for the transmission to complete.  Unfortunately,
602          * the hardware doesn't give us an interrupt to indicate
603          * "end of frame".
604          */
605         do
606                 rmb();
607         while (!(Ser2HSSR0 & HSSR0_TUR) || Ser2HSSR1 & HSSR1_TBY);
608
609         /*
610          * Clear the transmit underrun bit.
611          */
612         Ser2HSSR0 = HSSR0_TUR;
613
614         /*
615          * Do we need to change speed?  Note that we're lazy
616          * here - we don't free the old rxskb.  We don't need
617          * to allocate a buffer either.
618          */
619         if (si->newspeed) {
620                 sa1100_irda_set_speed(si, si->newspeed);
621                 si->newspeed = 0;
622         }
623
624         /*
625          * Start reception.  This disables the transmitter for
626          * us.  This will be using the existing RX buffer.
627          */
628         sa1100_irda_rx_dma_start(si);
629
630         /*
631          * Account and free the packet.
632          */
633         if (skb) {
634                 dma_unmap_single(si->dev, si->txbuf_dma, skb->len, DMA_TO_DEVICE);
635                 dev->stats.tx_packets ++;
636                 dev->stats.tx_bytes += skb->len;
637                 dev_kfree_skb_irq(skb);
638         }
639
640         /*
641          * Make sure that the TX queue is available for sending
642          * (for retries).  TX has priority over RX at all times.
643          */
644         netif_wake_queue(dev);
645 }
646
647 static int sa1100_irda_hard_xmit(struct sk_buff *skb, struct net_device *dev)
648 {
649         struct sa1100_irda *si = netdev_priv(dev);
650         int speed = irda_get_next_speed(skb);
651
652         /*
653          * Does this packet contain a request to change the interface
654          * speed?  If so, remember it until we complete the transmission
655          * of this frame.
656          */
657         if (speed != si->speed && speed != -1)
658                 si->newspeed = speed;
659
660         /*
661          * If this is an empty frame, we can bypass a lot.
662          */
663         if (skb->len == 0) {
664                 if (si->newspeed) {
665                         si->newspeed = 0;
666                         sa1100_irda_set_speed(si, speed);
667                 }
668                 dev_kfree_skb(skb);
669                 return NETDEV_TX_OK;
670         }
671
672         if (!IS_FIR(si)) {
673                 netif_stop_queue(dev);
674
675                 si->tx_buff.data = si->tx_buff.head;
676                 si->tx_buff.len  = async_wrap_skb(skb, si->tx_buff.data,
677                                                   si->tx_buff.truesize);
678
679                 /*
680                  * Set the transmit interrupt enable.  This will fire
681                  * off an interrupt immediately.  Note that we disable
682                  * the receiver so we won't get spurious characteres
683                  * received.
684                  */
685                 Ser2UTCR3 = UTCR3_TIE | UTCR3_TXE;
686
687                 dev_kfree_skb(skb);
688         } else {
689                 int mtt = irda_get_mtt(skb);
690
691                 /*
692                  * We must not be transmitting...
693                  */
694                 BUG_ON(si->txskb);
695
696                 netif_stop_queue(dev);
697
698                 si->txskb = skb;
699                 si->txbuf_dma = dma_map_single(si->dev, skb->data,
700                                          skb->len, DMA_TO_DEVICE);
701
702                 sa1100_start_dma(si->txdma, si->txbuf_dma, skb->len);
703
704                 /*
705                  * If we have a mean turn-around time, impose the specified
706                  * specified delay.  We could shorten this by timing from
707                  * the point we received the packet.
708                  */
709                 if (mtt)
710                         udelay(mtt);
711
712                 Ser2HSCR0 = si->hscr0 | HSCR0_HSSP | HSCR0_TXE;
713         }
714
715         dev->trans_start = jiffies;
716
717         return NETDEV_TX_OK;
718 }
719
720 static int
721 sa1100_irda_ioctl(struct net_device *dev, struct ifreq *ifreq, int cmd)
722 {
723         struct if_irda_req *rq = (struct if_irda_req *)ifreq;
724         struct sa1100_irda *si = netdev_priv(dev);
725         int ret = -EOPNOTSUPP;
726
727         switch (cmd) {
728         case SIOCSBANDWIDTH:
729                 if (capable(CAP_NET_ADMIN)) {
730                         /*
731                          * We are unable to set the speed if the
732                          * device is not running.
733                          */
734                         if (si->open) {
735                                 ret = sa1100_irda_set_speed(si,
736                                                 rq->ifr_baudrate);
737                         } else {
738                                 printk("sa1100_irda_ioctl: SIOCSBANDWIDTH: !netif_running\n");
739                                 ret = 0;
740                         }
741                 }
742                 break;
743
744         case SIOCSMEDIABUSY:
745                 ret = -EPERM;
746                 if (capable(CAP_NET_ADMIN)) {
747                         irda_device_set_media_busy(dev, TRUE);
748                         ret = 0;
749                 }
750                 break;
751
752         case SIOCGRECEIVING:
753                 rq->ifr_receiving = IS_FIR(si) ? 0
754                                         : si->rx_buff.state != OUTSIDE_FRAME;
755                 break;
756
757         default:
758                 break;
759         }
760                 
761         return ret;
762 }
763
764 static int sa1100_irda_start(struct net_device *dev)
765 {
766         struct sa1100_irda *si = netdev_priv(dev);
767         int err;
768
769         si->speed = 9600;
770
771         err = request_irq(dev->irq, sa1100_irda_irq, 0, dev->name, dev);
772         if (err)
773                 goto err_irq;
774
775         err = sa1100_request_dma(DMA_Ser2HSSPRd, "IrDA receive",
776                                  NULL, NULL, &si->rxdma);
777         if (err)
778                 goto err_rx_dma;
779
780         err = sa1100_request_dma(DMA_Ser2HSSPWr, "IrDA transmit",
781                                  sa1100_irda_txdma_irq, dev, &si->txdma);
782         if (err)
783                 goto err_tx_dma;
784
785         /*
786          * The interrupt must remain disabled for now.
787          */
788         disable_irq(dev->irq);
789
790         /*
791          * Setup the serial port for the specified speed.
792          */
793         err = sa1100_irda_startup(si);
794         if (err)
795                 goto err_startup;
796
797         /*
798          * Open a new IrLAP layer instance.
799          */
800         si->irlap = irlap_open(dev, &si->qos, "sa1100");
801         err = -ENOMEM;
802         if (!si->irlap)
803                 goto err_irlap;
804
805         /*
806          * Now enable the interrupt and start the queue
807          */
808         si->open = 1;
809         sa1100_set_power(si, power_level); /* low power mode */
810         enable_irq(dev->irq);
811         netif_start_queue(dev);
812         return 0;
813
814 err_irlap:
815         si->open = 0;
816         sa1100_irda_shutdown(si);
817 err_startup:
818         sa1100_free_dma(si->txdma);
819 err_tx_dma:
820         sa1100_free_dma(si->rxdma);
821 err_rx_dma:
822         free_irq(dev->irq, dev);
823 err_irq:
824         return err;
825 }
826
827 static int sa1100_irda_stop(struct net_device *dev)
828 {
829         struct sa1100_irda *si = netdev_priv(dev);
830
831         disable_irq(dev->irq);
832         sa1100_irda_shutdown(si);
833
834         /*
835          * If we have been doing DMA receive, make sure we
836          * tidy that up cleanly.
837          */
838         if (si->rxskb) {
839                 dma_unmap_single(si->dev, si->rxbuf_dma, HPSIR_MAX_RXLEN,
840                                  DMA_FROM_DEVICE);
841                 dev_kfree_skb(si->rxskb);
842                 si->rxskb = NULL;
843         }
844
845         /* Stop IrLAP */
846         if (si->irlap) {
847                 irlap_close(si->irlap);
848                 si->irlap = NULL;
849         }
850
851         netif_stop_queue(dev);
852         si->open = 0;
853
854         /*
855          * Free resources
856          */
857         sa1100_free_dma(si->txdma);
858         sa1100_free_dma(si->rxdma);
859         free_irq(dev->irq, dev);
860
861         sa1100_set_power(si, 0);
862
863         return 0;
864 }
865
866 static int sa1100_irda_init_iobuf(iobuff_t *io, int size)
867 {
868         io->head = kmalloc(size, GFP_KERNEL | GFP_DMA);
869         if (io->head != NULL) {
870                 io->truesize = size;
871                 io->in_frame = FALSE;
872                 io->state    = OUTSIDE_FRAME;
873                 io->data     = io->head;
874         }
875         return io->head ? 0 : -ENOMEM;
876 }
877
878 static const struct net_device_ops sa1100_irda_netdev_ops = {
879         .ndo_open               = sa1100_irda_start,
880         .ndo_stop               = sa1100_irda_stop,
881         .ndo_start_xmit         = sa1100_irda_hard_xmit,
882         .ndo_do_ioctl           = sa1100_irda_ioctl,
883 };
884
885 static int sa1100_irda_probe(struct platform_device *pdev)
886 {
887         struct net_device *dev;
888         struct sa1100_irda *si;
889         unsigned int baudrate_mask;
890         int err;
891
892         if (!pdev->dev.platform_data)
893                 return -EINVAL;
894
895         err = request_mem_region(__PREG(Ser2UTCR0), 0x24, "IrDA") ? 0 : -EBUSY;
896         if (err)
897                 goto err_mem_1;
898         err = request_mem_region(__PREG(Ser2HSCR0), 0x1c, "IrDA") ? 0 : -EBUSY;
899         if (err)
900                 goto err_mem_2;
901         err = request_mem_region(__PREG(Ser2HSCR2), 0x04, "IrDA") ? 0 : -EBUSY;
902         if (err)
903                 goto err_mem_3;
904
905         dev = alloc_irdadev(sizeof(struct sa1100_irda));
906         if (!dev)
907                 goto err_mem_4;
908
909         si = netdev_priv(dev);
910         si->dev = &pdev->dev;
911         si->pdata = pdev->dev.platform_data;
912
913         /*
914          * Initialise the HP-SIR buffers
915          */
916         err = sa1100_irda_init_iobuf(&si->rx_buff, 14384);
917         if (err)
918                 goto err_mem_5;
919         err = sa1100_irda_init_iobuf(&si->tx_buff, 4000);
920         if (err)
921                 goto err_mem_5;
922
923         dev->netdev_ops = &sa1100_irda_netdev_ops;
924         dev->irq        = IRQ_Ser2ICP;
925
926         irda_init_max_qos_capabilies(&si->qos);
927
928         /*
929          * We support original IRDA up to 115k2. (we don't currently
930          * support 4Mbps).  Min Turn Time set to 1ms or greater.
931          */
932         baudrate_mask = IR_9600;
933
934         switch (max_rate) {
935         case 4000000:           baudrate_mask |= IR_4000000 << 8;
936         case 115200:            baudrate_mask |= IR_115200;
937         case 57600:             baudrate_mask |= IR_57600;
938         case 38400:             baudrate_mask |= IR_38400;
939         case 19200:             baudrate_mask |= IR_19200;
940         }
941                 
942         si->qos.baud_rate.bits &= baudrate_mask;
943         si->qos.min_turn_time.bits = 7;
944
945         irda_qos_bits_to_value(&si->qos);
946
947         si->utcr4 = UTCR4_HPSIR;
948         if (tx_lpm)
949                 si->utcr4 |= UTCR4_Z1_6us;
950
951         /*
952          * Initially enable HP-SIR modulation, and ensure that the port
953          * is disabled.
954          */
955         Ser2UTCR3 = 0;
956         Ser2UTCR4 = si->utcr4;
957         Ser2HSCR0 = HSCR0_UART;
958
959         err = register_netdev(dev);
960         if (err == 0)
961                 platform_set_drvdata(pdev, dev);
962
963         if (err) {
964  err_mem_5:
965                 kfree(si->tx_buff.head);
966                 kfree(si->rx_buff.head);
967                 free_netdev(dev);
968  err_mem_4:
969                 release_mem_region(__PREG(Ser2HSCR2), 0x04);
970  err_mem_3:
971                 release_mem_region(__PREG(Ser2HSCR0), 0x1c);
972  err_mem_2:
973                 release_mem_region(__PREG(Ser2UTCR0), 0x24);
974         }
975  err_mem_1:
976         return err;
977 }
978
979 static int sa1100_irda_remove(struct platform_device *pdev)
980 {
981         struct net_device *dev = platform_get_drvdata(pdev);
982
983         if (dev) {
984                 struct sa1100_irda *si = netdev_priv(dev);
985                 unregister_netdev(dev);
986                 kfree(si->tx_buff.head);
987                 kfree(si->rx_buff.head);
988                 free_netdev(dev);
989         }
990
991         release_mem_region(__PREG(Ser2HSCR2), 0x04);
992         release_mem_region(__PREG(Ser2HSCR0), 0x1c);
993         release_mem_region(__PREG(Ser2UTCR0), 0x24);
994
995         return 0;
996 }
997
998 static struct platform_driver sa1100ir_driver = {
999         .probe          = sa1100_irda_probe,
1000         .remove         = sa1100_irda_remove,
1001         .suspend        = sa1100_irda_suspend,
1002         .resume         = sa1100_irda_resume,
1003         .driver         = {
1004                 .name   = "sa11x0-ir",
1005                 .owner  = THIS_MODULE,
1006         },
1007 };
1008
1009 static int __init sa1100_irda_init(void)
1010 {
1011         /*
1012          * Limit power level a sensible range.
1013          */
1014         if (power_level < 1)
1015                 power_level = 1;
1016         if (power_level > 3)
1017                 power_level = 3;
1018
1019         return platform_driver_register(&sa1100ir_driver);
1020 }
1021
1022 static void __exit sa1100_irda_exit(void)
1023 {
1024         platform_driver_unregister(&sa1100ir_driver);
1025 }
1026
1027 module_init(sa1100_irda_init);
1028 module_exit(sa1100_irda_exit);
1029 module_param(power_level, int, 0);
1030 module_param(tx_lpm, int, 0);
1031 module_param(max_rate, int, 0);
1032
1033 MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
1034 MODULE_DESCRIPTION("StrongARM SA1100 IrDA driver");
1035 MODULE_LICENSE("GPL");
1036 MODULE_PARM_DESC(power_level, "IrDA power level, 1 (low) to 3 (high)");
1037 MODULE_PARM_DESC(tx_lpm, "Enable transmitter low power (1.6us) mode");
1038 MODULE_PARM_DESC(max_rate, "Maximum baud rate (4000000, 115200, 57600, 38400, 19200, 9600)");
1039 MODULE_ALIAS("platform:sa11x0-ir");