ath9k: Use helpers
[pandora-kernel.git] / drivers / serial / sc26xx.c
1 /*
2  * SC268xx.c: Serial driver for Philiphs SC2681/SC2692 devices.
3  *
4  * Copyright (C) 2006,2007 Thomas Bogendörfer (tsbogend@alpha.franken.de)
5  */
6
7 #include <linux/module.h>
8 #include <linux/kernel.h>
9 #include <linux/errno.h>
10 #include <linux/tty.h>
11 #include <linux/tty_flip.h>
12 #include <linux/major.h>
13 #include <linux/circ_buf.h>
14 #include <linux/serial.h>
15 #include <linux/sysrq.h>
16 #include <linux/console.h>
17 #include <linux/spinlock.h>
18 #include <linux/slab.h>
19 #include <linux/delay.h>
20 #include <linux/init.h>
21 #include <linux/platform_device.h>
22 #include <linux/irq.h>
23
24 #if defined(CONFIG_MAGIC_SYSRQ)
25 #define SUPPORT_SYSRQ
26 #endif
27
28 #include <linux/serial_core.h>
29
30 #define SC26XX_MAJOR         204
31 #define SC26XX_MINOR_START   205
32 #define SC26XX_NR            2
33
34 struct uart_sc26xx_port {
35         struct uart_port      port[2];
36         u8     dsr_mask[2];
37         u8     cts_mask[2];
38         u8     dcd_mask[2];
39         u8     ri_mask[2];
40         u8     dtr_mask[2];
41         u8     rts_mask[2];
42         u8     imr;
43 };
44
45 /* register common to both ports */
46 #define RD_ISR      0x14
47 #define RD_IPR      0x34
48
49 #define WR_ACR      0x10
50 #define WR_IMR      0x14
51 #define WR_OPCR     0x34
52 #define WR_OPR_SET  0x38
53 #define WR_OPR_CLR  0x3C
54
55 /* access common register */
56 #define READ_SC(p, r)        readb((p)->membase + RD_##r)
57 #define WRITE_SC(p, r, v)    writeb((v), (p)->membase + WR_##r)
58
59 /* register per port */
60 #define RD_PORT_MRx 0x00
61 #define RD_PORT_SR  0x04
62 #define RD_PORT_RHR 0x0c
63
64 #define WR_PORT_MRx 0x00
65 #define WR_PORT_CSR 0x04
66 #define WR_PORT_CR  0x08
67 #define WR_PORT_THR 0x0c
68
69 /* SR bits */
70 #define SR_BREAK    (1 << 7)
71 #define SR_FRAME    (1 << 6)
72 #define SR_PARITY   (1 << 5)
73 #define SR_OVERRUN  (1 << 4)
74 #define SR_TXRDY    (1 << 2)
75 #define SR_RXRDY    (1 << 0)
76
77 #define CR_RES_MR   (1 << 4)
78 #define CR_RES_RX   (2 << 4)
79 #define CR_RES_TX   (3 << 4)
80 #define CR_STRT_BRK (6 << 4)
81 #define CR_STOP_BRK (7 << 4)
82 #define CR_DIS_TX   (1 << 3)
83 #define CR_ENA_TX   (1 << 2)
84 #define CR_DIS_RX   (1 << 1)
85 #define CR_ENA_RX   (1 << 0)
86
87 /* ISR bits */
88 #define ISR_RXRDYB  (1 << 5)
89 #define ISR_TXRDYB  (1 << 4)
90 #define ISR_RXRDYA  (1 << 1)
91 #define ISR_TXRDYA  (1 << 0)
92
93 /* IMR bits */
94 #define IMR_RXRDY   (1 << 1)
95 #define IMR_TXRDY   (1 << 0)
96
97 /* access port register */
98 static inline u8 read_sc_port(struct uart_port *p, u8 reg)
99 {
100         return readb(p->membase + p->line * 0x20 + reg);
101 }
102
103 static inline void write_sc_port(struct uart_port *p, u8 reg, u8 val)
104 {
105         writeb(val, p->membase + p->line * 0x20 + reg);
106 }
107
108 #define READ_SC_PORT(p, r)     read_sc_port(p, RD_PORT_##r)
109 #define WRITE_SC_PORT(p, r, v) write_sc_port(p, WR_PORT_##r, v)
110
111 static void sc26xx_enable_irq(struct uart_port *port, int mask)
112 {
113         struct uart_sc26xx_port *up;
114         int line = port->line;
115
116         port -= line;
117         up = container_of(port, struct uart_sc26xx_port, port[0]);
118
119         up->imr |= mask << (line * 4);
120         WRITE_SC(port, IMR, up->imr);
121 }
122
123 static void sc26xx_disable_irq(struct uart_port *port, int mask)
124 {
125         struct uart_sc26xx_port *up;
126         int line = port->line;
127
128         port -= line;
129         up = container_of(port, struct uart_sc26xx_port, port[0]);
130
131         up->imr &= ~(mask << (line * 4));
132         WRITE_SC(port, IMR, up->imr);
133 }
134
135 static struct tty_struct *receive_chars(struct uart_port *port)
136 {
137         struct tty_struct *tty = NULL;
138         int limit = 10000;
139         unsigned char ch;
140         char flag;
141         u8 status;
142
143         if (port->info != NULL)         /* Unopened serial console */
144                 tty = port->info->port.tty;
145
146         while (limit-- > 0) {
147                 status = READ_SC_PORT(port, SR);
148                 if (!(status & SR_RXRDY))
149                         break;
150                 ch = READ_SC_PORT(port, RHR);
151
152                 flag = TTY_NORMAL;
153                 port->icount.rx++;
154
155                 if (unlikely(status & (SR_BREAK | SR_FRAME |
156                                        SR_PARITY | SR_OVERRUN))) {
157                         if (status & SR_BREAK) {
158                                 status &= ~(SR_PARITY | SR_FRAME);
159                                 port->icount.brk++;
160                                 if (uart_handle_break(port))
161                                         continue;
162                         } else if (status & SR_PARITY)
163                                 port->icount.parity++;
164                         else if (status & SR_FRAME)
165                                 port->icount.frame++;
166                         if (status & SR_OVERRUN)
167                                 port->icount.overrun++;
168
169                         status &= port->read_status_mask;
170                         if (status & SR_BREAK)
171                                 flag = TTY_BREAK;
172                         else if (status & SR_PARITY)
173                                 flag = TTY_PARITY;
174                         else if (status & SR_FRAME)
175                                 flag = TTY_FRAME;
176                 }
177
178                 if (uart_handle_sysrq_char(port, ch))
179                         continue;
180
181                 if (status & port->ignore_status_mask)
182                         continue;
183
184                 tty_insert_flip_char(tty, ch, flag);
185         }
186         return tty;
187 }
188
189 static void transmit_chars(struct uart_port *port)
190 {
191         struct circ_buf *xmit;
192
193         if (!port->info)
194                 return;
195
196         xmit = &port->info->xmit;
197         if (uart_circ_empty(xmit) || uart_tx_stopped(port)) {
198                 sc26xx_disable_irq(port, IMR_TXRDY);
199                 return;
200         }
201         while (!uart_circ_empty(xmit)) {
202                 if (!(READ_SC_PORT(port, SR) & SR_TXRDY))
203                         break;
204
205                 WRITE_SC_PORT(port, THR, xmit->buf[xmit->tail]);
206                 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
207                 port->icount.tx++;
208         }
209         if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
210                 uart_write_wakeup(port);
211 }
212
213 static irqreturn_t sc26xx_interrupt(int irq, void *dev_id)
214 {
215         struct uart_sc26xx_port *up = dev_id;
216         struct tty_struct *tty;
217         unsigned long flags;
218         u8 isr;
219
220         spin_lock_irqsave(&up->port[0].lock, flags);
221
222         tty = NULL;
223         isr = READ_SC(&up->port[0], ISR);
224         if (isr & ISR_TXRDYA)
225             transmit_chars(&up->port[0]);
226         if (isr & ISR_RXRDYA)
227             tty = receive_chars(&up->port[0]);
228
229         spin_unlock(&up->port[0].lock);
230
231         if (tty)
232                 tty_flip_buffer_push(tty);
233
234         spin_lock(&up->port[1].lock);
235
236         tty = NULL;
237         if (isr & ISR_TXRDYB)
238             transmit_chars(&up->port[1]);
239         if (isr & ISR_RXRDYB)
240             tty = receive_chars(&up->port[1]);
241
242         spin_unlock_irqrestore(&up->port[1].lock, flags);
243
244         if (tty)
245                 tty_flip_buffer_push(tty);
246
247         return IRQ_HANDLED;
248 }
249
250 /* port->lock is not held.  */
251 static unsigned int sc26xx_tx_empty(struct uart_port *port)
252 {
253         return (READ_SC_PORT(port, SR) & SR_TXRDY) ? TIOCSER_TEMT : 0;
254 }
255
256 /* port->lock held by caller.  */
257 static void sc26xx_set_mctrl(struct uart_port *port, unsigned int mctrl)
258 {
259         struct uart_sc26xx_port *up;
260         int line = port->line;
261
262         port -= line;
263         up = container_of(port, struct uart_sc26xx_port, port[0]);
264
265         if (up->dtr_mask[line]) {
266                 if (mctrl & TIOCM_DTR)
267                         WRITE_SC(port, OPR_SET, up->dtr_mask[line]);
268                 else
269                         WRITE_SC(port, OPR_CLR, up->dtr_mask[line]);
270         }
271         if (up->rts_mask[line]) {
272                 if (mctrl & TIOCM_RTS)
273                         WRITE_SC(port, OPR_SET, up->rts_mask[line]);
274                 else
275                         WRITE_SC(port, OPR_CLR, up->rts_mask[line]);
276         }
277 }
278
279 /* port->lock is held by caller and interrupts are disabled.  */
280 static unsigned int sc26xx_get_mctrl(struct uart_port *port)
281 {
282         struct uart_sc26xx_port *up;
283         int line = port->line;
284         unsigned int mctrl = TIOCM_DSR | TIOCM_CTS | TIOCM_CAR;
285         u8 ipr;
286
287         port -= line;
288         up = container_of(port, struct uart_sc26xx_port, port[0]);
289         ipr = READ_SC(port, IPR) ^ 0xff;
290
291         if (up->dsr_mask[line]) {
292                 mctrl &= ~TIOCM_DSR;
293                 mctrl |= ipr & up->dsr_mask[line] ? TIOCM_DSR : 0;
294         }
295         if (up->cts_mask[line]) {
296                 mctrl &= ~TIOCM_CTS;
297                 mctrl |= ipr & up->cts_mask[line] ? TIOCM_CTS : 0;
298         }
299         if (up->dcd_mask[line]) {
300                 mctrl &= ~TIOCM_CAR;
301                 mctrl |= ipr & up->dcd_mask[line] ? TIOCM_CAR : 0;
302         }
303         if (up->ri_mask[line]) {
304                 mctrl &= ~TIOCM_RNG;
305                 mctrl |= ipr & up->ri_mask[line] ? TIOCM_RNG : 0;
306         }
307         return mctrl;
308 }
309
310 /* port->lock held by caller.  */
311 static void sc26xx_stop_tx(struct uart_port *port)
312 {
313         return;
314 }
315
316 /* port->lock held by caller.  */
317 static void sc26xx_start_tx(struct uart_port *port)
318 {
319         struct circ_buf *xmit = &port->info->xmit;
320
321         while (!uart_circ_empty(xmit)) {
322                 if (!(READ_SC_PORT(port, SR) & SR_TXRDY)) {
323                         sc26xx_enable_irq(port, IMR_TXRDY);
324                         break;
325                 }
326                 WRITE_SC_PORT(port, THR, xmit->buf[xmit->tail]);
327                 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
328                 port->icount.tx++;
329         }
330 }
331
332 /* port->lock held by caller.  */
333 static void sc26xx_stop_rx(struct uart_port *port)
334 {
335 }
336
337 /* port->lock held by caller.  */
338 static void sc26xx_enable_ms(struct uart_port *port)
339 {
340 }
341
342 /* port->lock is not held.  */
343 static void sc26xx_break_ctl(struct uart_port *port, int break_state)
344 {
345         if (break_state == -1)
346                 WRITE_SC_PORT(port, CR, CR_STRT_BRK);
347         else
348                 WRITE_SC_PORT(port, CR, CR_STOP_BRK);
349 }
350
351 /* port->lock is not held.  */
352 static int sc26xx_startup(struct uart_port *port)
353 {
354         sc26xx_disable_irq(port, IMR_TXRDY | IMR_RXRDY);
355         WRITE_SC(port, OPCR, 0);
356
357         /* reset tx and rx */
358         WRITE_SC_PORT(port, CR, CR_RES_RX);
359         WRITE_SC_PORT(port, CR, CR_RES_TX);
360
361         /* start rx/tx */
362         WRITE_SC_PORT(port, CR, CR_ENA_TX | CR_ENA_RX);
363
364         /* enable irqs */
365         sc26xx_enable_irq(port, IMR_RXRDY);
366         return 0;
367 }
368
369 /* port->lock is not held.  */
370 static void sc26xx_shutdown(struct uart_port *port)
371 {
372         /* disable interrupst */
373         sc26xx_disable_irq(port, IMR_TXRDY | IMR_RXRDY);
374
375         /* stop tx/rx */
376         WRITE_SC_PORT(port, CR, CR_DIS_TX | CR_DIS_RX);
377 }
378
379 /* port->lock is not held.  */
380 static void sc26xx_set_termios(struct uart_port *port, struct ktermios *termios,
381                               struct ktermios *old)
382 {
383         unsigned int baud = uart_get_baud_rate(port, termios, old, 0, 4000000);
384         unsigned int quot = uart_get_divisor(port, baud);
385         unsigned int iflag, cflag;
386         unsigned long flags;
387         u8 mr1, mr2, csr;
388
389         spin_lock_irqsave(&port->lock, flags);
390
391         while ((READ_SC_PORT(port, SR) & ((1 << 3) | (1 << 2))) != 0xc)
392                 udelay(2);
393
394         WRITE_SC_PORT(port, CR, CR_DIS_TX | CR_DIS_RX);
395
396         iflag = termios->c_iflag;
397         cflag = termios->c_cflag;
398
399         port->read_status_mask = SR_OVERRUN;
400         if (iflag & INPCK)
401                 port->read_status_mask |= SR_PARITY | SR_FRAME;
402         if (iflag & (BRKINT | PARMRK))
403                 port->read_status_mask |= SR_BREAK;
404
405         port->ignore_status_mask = 0;
406         if (iflag & IGNBRK)
407                 port->ignore_status_mask |= SR_BREAK;
408         if ((cflag & CREAD) == 0)
409                 port->ignore_status_mask |= SR_BREAK | SR_FRAME |
410                                             SR_PARITY | SR_OVERRUN;
411
412         switch (cflag & CSIZE) {
413         case CS5:
414                 mr1 = 0x00;
415                 break;
416         case CS6:
417                 mr1 = 0x01;
418                 break;
419         case CS7:
420                 mr1 = 0x02;
421                 break;
422         default:
423         case CS8:
424                 mr1 = 0x03;
425                 break;
426         }
427         mr2 = 0x07;
428         if (cflag & CSTOPB)
429                 mr2 = 0x0f;
430         if (cflag & PARENB) {
431                 if (cflag & PARODD)
432                         mr1 |= (1 << 2);
433         } else
434                 mr1 |= (2 << 3);
435
436         switch (baud) {
437         case 50:
438                 csr = 0x00;
439                 break;
440         case 110:
441                 csr = 0x11;
442                 break;
443         case 134:
444                 csr = 0x22;
445                 break;
446         case 200:
447                 csr = 0x33;
448                 break;
449         case 300:
450                 csr = 0x44;
451                 break;
452         case 600:
453                 csr = 0x55;
454                 break;
455         case 1200:
456                 csr = 0x66;
457                 break;
458         case 2400:
459                 csr = 0x88;
460                 break;
461         case 4800:
462                 csr = 0x99;
463                 break;
464         default:
465         case 9600:
466                 csr = 0xbb;
467                 break;
468         case 19200:
469                 csr = 0xcc;
470                 break;
471         }
472
473         WRITE_SC_PORT(port, CR, CR_RES_MR);
474         WRITE_SC_PORT(port, MRx, mr1);
475         WRITE_SC_PORT(port, MRx, mr2);
476
477         WRITE_SC(port, ACR, 0x80);
478         WRITE_SC_PORT(port, CSR, csr);
479
480         /* reset tx and rx */
481         WRITE_SC_PORT(port, CR, CR_RES_RX);
482         WRITE_SC_PORT(port, CR, CR_RES_TX);
483
484         WRITE_SC_PORT(port, CR, CR_ENA_TX | CR_ENA_RX);
485         while ((READ_SC_PORT(port, SR) & ((1 << 3) | (1 << 2))) != 0xc)
486                 udelay(2);
487
488         /* XXX */
489         uart_update_timeout(port, cflag,
490                             (port->uartclk / (16 * quot)));
491
492         spin_unlock_irqrestore(&port->lock, flags);
493 }
494
495 static const char *sc26xx_type(struct uart_port *port)
496 {
497         return "SC26XX";
498 }
499
500 static void sc26xx_release_port(struct uart_port *port)
501 {
502 }
503
504 static int sc26xx_request_port(struct uart_port *port)
505 {
506         return 0;
507 }
508
509 static void sc26xx_config_port(struct uart_port *port, int flags)
510 {
511 }
512
513 static int sc26xx_verify_port(struct uart_port *port, struct serial_struct *ser)
514 {
515         return -EINVAL;
516 }
517
518 static struct uart_ops sc26xx_ops = {
519         .tx_empty       = sc26xx_tx_empty,
520         .set_mctrl      = sc26xx_set_mctrl,
521         .get_mctrl      = sc26xx_get_mctrl,
522         .stop_tx        = sc26xx_stop_tx,
523         .start_tx       = sc26xx_start_tx,
524         .stop_rx        = sc26xx_stop_rx,
525         .enable_ms      = sc26xx_enable_ms,
526         .break_ctl      = sc26xx_break_ctl,
527         .startup        = sc26xx_startup,
528         .shutdown       = sc26xx_shutdown,
529         .set_termios    = sc26xx_set_termios,
530         .type           = sc26xx_type,
531         .release_port   = sc26xx_release_port,
532         .request_port   = sc26xx_request_port,
533         .config_port    = sc26xx_config_port,
534         .verify_port    = sc26xx_verify_port,
535 };
536
537 static struct uart_port *sc26xx_port;
538
539 #ifdef CONFIG_SERIAL_SC26XX_CONSOLE
540 static void sc26xx_console_putchar(struct uart_port *port, char c)
541 {
542         unsigned long flags;
543         int limit = 1000000;
544
545         spin_lock_irqsave(&port->lock, flags);
546
547         while (limit-- > 0) {
548                 if (READ_SC_PORT(port, SR) & SR_TXRDY) {
549                         WRITE_SC_PORT(port, THR, c);
550                         break;
551                 }
552                 udelay(2);
553         }
554
555         spin_unlock_irqrestore(&port->lock, flags);
556 }
557
558 static void sc26xx_console_write(struct console *con, const char *s, unsigned n)
559 {
560         struct uart_port *port = sc26xx_port;
561         int i;
562
563         for (i = 0; i < n; i++) {
564                 if (*s == '\n')
565                         sc26xx_console_putchar(port, '\r');
566                 sc26xx_console_putchar(port, *s++);
567         }
568 }
569
570 static int __init sc26xx_console_setup(struct console *con, char *options)
571 {
572         struct uart_port *port = sc26xx_port;
573         int baud = 9600;
574         int bits = 8;
575         int parity = 'n';
576         int flow = 'n';
577
578         if (port->type != PORT_SC26XX)
579                 return -1;
580
581         printk(KERN_INFO "Console: ttySC%d (SC26XX)\n", con->index);
582         if (options)
583                 uart_parse_options(options, &baud, &parity, &bits, &flow);
584
585         return uart_set_options(port, con, baud, parity, bits, flow);
586 }
587
588 static struct uart_driver sc26xx_reg;
589 static struct console sc26xx_console = {
590         .name   =       "ttySC",
591         .write  =       sc26xx_console_write,
592         .device =       uart_console_device,
593         .setup  =       sc26xx_console_setup,
594         .flags  =       CON_PRINTBUFFER,
595         .index  =       -1,
596         .data   =       &sc26xx_reg,
597 };
598 #define SC26XX_CONSOLE   &sc26xx_console
599 #else
600 #define SC26XX_CONSOLE   NULL
601 #endif
602
603 static struct uart_driver sc26xx_reg = {
604         .owner                  = THIS_MODULE,
605         .driver_name            = "SC26xx",
606         .dev_name               = "ttySC",
607         .major                  = SC26XX_MAJOR,
608         .minor                  = SC26XX_MINOR_START,
609         .nr                     = SC26XX_NR,
610         .cons                   = SC26XX_CONSOLE,
611 };
612
613 static u8 sc26xx_flags2mask(unsigned int flags, unsigned int bitpos)
614 {
615         unsigned int bit = (flags >> bitpos) & 15;
616
617         return bit ? (1 << (bit - 1)) : 0;
618 }
619
620 static void __devinit sc26xx_init_masks(struct uart_sc26xx_port *up,
621                                         int line, unsigned int data)
622 {
623         up->dtr_mask[line] = sc26xx_flags2mask(data,  0);
624         up->rts_mask[line] = sc26xx_flags2mask(data,  4);
625         up->dsr_mask[line] = sc26xx_flags2mask(data,  8);
626         up->cts_mask[line] = sc26xx_flags2mask(data, 12);
627         up->dcd_mask[line] = sc26xx_flags2mask(data, 16);
628         up->ri_mask[line]  = sc26xx_flags2mask(data, 20);
629 }
630
631 static int __devinit sc26xx_probe(struct platform_device *dev)
632 {
633         struct resource *res;
634         struct uart_sc26xx_port *up;
635         unsigned int *sc26xx_data = dev->dev.platform_data;
636         int err;
637
638         res = platform_get_resource(dev, IORESOURCE_MEM, 0);
639         if (!res)
640                 return -ENODEV;
641
642         up = kzalloc(sizeof *up, GFP_KERNEL);
643         if (unlikely(!up))
644                 return -ENOMEM;
645
646         up->port[0].line = 0;
647         up->port[0].ops = &sc26xx_ops;
648         up->port[0].type = PORT_SC26XX;
649         up->port[0].uartclk = (29491200 / 16); /* arbitrary */
650
651         up->port[0].mapbase = res->start;
652         up->port[0].membase = ioremap_nocache(up->port[0].mapbase, 0x40);
653         up->port[0].iotype = UPIO_MEM;
654         up->port[0].irq = platform_get_irq(dev, 0);
655
656         up->port[0].dev = &dev->dev;
657
658         sc26xx_init_masks(up, 0, sc26xx_data[0]);
659
660         sc26xx_port = &up->port[0];
661
662         up->port[1].line = 1;
663         up->port[1].ops = &sc26xx_ops;
664         up->port[1].type = PORT_SC26XX;
665         up->port[1].uartclk = (29491200 / 16); /* arbitrary */
666
667         up->port[1].mapbase = up->port[0].mapbase;
668         up->port[1].membase = up->port[0].membase;
669         up->port[1].iotype = UPIO_MEM;
670         up->port[1].irq = up->port[0].irq;
671
672         up->port[1].dev = &dev->dev;
673
674         sc26xx_init_masks(up, 1, sc26xx_data[1]);
675
676         err = uart_register_driver(&sc26xx_reg);
677         if (err)
678                 goto out_free_port;
679
680         sc26xx_reg.tty_driver->name_base = sc26xx_reg.minor;
681
682         err = uart_add_one_port(&sc26xx_reg, &up->port[0]);
683         if (err)
684                 goto out_unregister_driver;
685
686         err = uart_add_one_port(&sc26xx_reg, &up->port[1]);
687         if (err)
688                 goto out_remove_port0;
689
690         err = request_irq(up->port[0].irq, sc26xx_interrupt, 0, "sc26xx", up);
691         if (err)
692                 goto out_remove_ports;
693
694         dev_set_drvdata(&dev->dev, up);
695         return 0;
696
697 out_remove_ports:
698         uart_remove_one_port(&sc26xx_reg, &up->port[1]);
699 out_remove_port0:
700         uart_remove_one_port(&sc26xx_reg, &up->port[0]);
701
702 out_unregister_driver:
703         uart_unregister_driver(&sc26xx_reg);
704
705 out_free_port:
706         kfree(up);
707         sc26xx_port = NULL;
708         return err;
709 }
710
711
712 static int __exit sc26xx_driver_remove(struct platform_device *dev)
713 {
714         struct uart_sc26xx_port *up = dev_get_drvdata(&dev->dev);
715
716         free_irq(up->port[0].irq, up);
717
718         uart_remove_one_port(&sc26xx_reg, &up->port[0]);
719         uart_remove_one_port(&sc26xx_reg, &up->port[1]);
720
721         uart_unregister_driver(&sc26xx_reg);
722
723         kfree(up);
724         sc26xx_port = NULL;
725
726         dev_set_drvdata(&dev->dev, NULL);
727         return 0;
728 }
729
730 static struct platform_driver sc26xx_driver = {
731         .probe  = sc26xx_probe,
732         .remove = __devexit_p(sc26xx_driver_remove),
733         .driver = {
734                 .name   = "SC26xx",
735                 .owner  = THIS_MODULE,
736         },
737 };
738
739 static int __init sc26xx_init(void)
740 {
741         return platform_driver_register(&sc26xx_driver);
742 }
743
744 static void __exit sc26xx_exit(void)
745 {
746         platform_driver_unregister(&sc26xx_driver);
747 }
748
749 module_init(sc26xx_init);
750 module_exit(sc26xx_exit);
751
752
753 MODULE_AUTHOR("Thomas Bogendörfer");
754 MODULE_DESCRIPTION("SC681/SC2692 serial driver");
755 MODULE_VERSION("1.0");
756 MODULE_LICENSE("GPL");
757 MODULE_ALIAS("platform:SC26xx");