?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
[XFRM]: skb_cow_data() does not set proper owner for new skbs.
[linux-2.6/verdex.git] / drivers / serial / mcfserial.c
blob8c40167778dea949e077954a10445736f9f6ea21
1 /*
2 * mcfserial.c -- serial driver for ColdFire internal UARTS.
3 *
4 * Copyright (C) 1999-2003 Greg Ungerer <gerg@snapgear.com>
5 * Copyright (c) 2000-2001 Lineo, Inc. <www.lineo.com>
6 * Copyright (C) 2001-2002 SnapGear Inc. <www.snapgear.com>
7 *
8 * Based on code from 68332serial.c which was:
9 *
10 * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
11 * Copyright (C) 1998 TSHG
12 * Copyright (c) 1999 Rt-Control Inc. <jeff@uclinux.org>
13 *
14 * Changes:
15 * 08/07/2003 Daniele Bellucci <bellucda@tiscali.it>
16 * some cleanups in mcfrs_write.
17 *
18 */
19
20 #include <linux/module.h>
21 #include <linux/errno.h>
22 #include <linux/signal.h>
23 #include <linux/sched.h>
24 #include <linux/timer.h>
25 #include <linux/wait.h>
26 #include <linux/interrupt.h>
27 #include <linux/tty.h>
28 #include <linux/tty_flip.h>
29 #include <linux/string.h>
30 #include <linux/fcntl.h>
31 #include <linux/mm.h>
32 #include <linux/kernel.h>
33 #include <linux/serial.h>
34 #include <linux/serialP.h>
35 #include <linux/console.h>
36 #include <linux/init.h>
37 #include <linux/bitops.h>
38 #include <linux/delay.h>
39
40 #include <asm/io.h>
41 #include <asm/irq.h>
42 #include <asm/system.h>
43 #include <asm/segment.h>
44 #include <asm/semaphore.h>
45 #include <asm/delay.h>
46 #include <asm/coldfire.h>
47 #include <asm/mcfsim.h>
48 #include <asm/mcfuart.h>
49 #include <asm/nettel.h>
50 #include <asm/uaccess.h>
51 #include "mcfserial.h"
52
53 struct timer_list mcfrs_timer_struct;
54
55 /*
56 * Default console baud rate, we use this as the default
57 * for all ports so init can just open /dev/console and
58 * keep going. Perhaps one day the cflag settings for the
59 * console can be used instead.
60 */
61 #if defined(CONFIG_ARNEWSH) || defined(CONFIG_MOTOROLA) || defined(CONFIG_senTec) || defined(CONFIG_SNEHA)
62 #define CONSOLE_BAUD_RATE 19200
63 #define DEFAULT_CBAUD B19200
64 #endif
65
66 #if defined(CONFIG_HW_FEITH)
67 #define CONSOLE_BAUD_RATE 38400
68 #define DEFAULT_CBAUD B38400
69 #endif
70
71 #ifndef CONSOLE_BAUD_RATE
72 #define CONSOLE_BAUD_RATE 9600
73 #define DEFAULT_CBAUD B9600
74 #endif
75
76 int mcfrs_console_inited = 0;
77 int mcfrs_console_port = -1;
78 int mcfrs_console_baud = CONSOLE_BAUD_RATE;
79 int mcfrs_console_cbaud = DEFAULT_CBAUD;
80
81 /*
82 * Driver data structures.
83 */
84 static struct tty_driver *mcfrs_serial_driver;
85
86 /* number of characters left in xmit buffer before we ask for more */
87 #define WAKEUP_CHARS 256
88
89 /* Debugging...
90 */
91 #undef SERIAL_DEBUG_OPEN
92 #undef SERIAL_DEBUG_FLOW
93
94 #if defined(CONFIG_M527x) || defined(CONFIG_M528x)
95 #define IRQBASE (MCFINT_VECBASE+MCFINT_UART0)
96 #else
97 #define IRQBASE 73
98 #endif
99
100 /*
101 * Configuration table, UARTs to look for at startup.
102 */
103 static struct mcf_serial mcfrs_table[] = {
104 { /* ttyS0 */
105 .magic = 0,
106 .addr = (volatile unsigned char *) (MCF_MBAR+MCFUART_BASE1),
107 .irq = IRQBASE,
108 .flags = ASYNC_BOOT_AUTOCONF,
109 },
110 { /* ttyS1 */
111 .magic = 0,
112 .addr = (volatile unsigned char *) (MCF_MBAR+MCFUART_BASE2),
113 .irq = IRQBASE+1,
114 .flags = ASYNC_BOOT_AUTOCONF,
115 },
116 };
117
118
119 #define NR_PORTS (sizeof(mcfrs_table) / sizeof(struct mcf_serial))
120
121 /*
122 * This is used to figure out the divisor speeds and the timeouts.
123 */
124 static int mcfrs_baud_table[] = {
125 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
126 9600, 19200, 38400, 57600, 115200, 230400, 460800, 0
127 };
128 #define MCFRS_BAUD_TABLE_SIZE \
129 (sizeof(mcfrs_baud_table)/sizeof(mcfrs_baud_table[0]))
130
131
132 #ifdef CONFIG_MAGIC_SYSRQ
133 /*
134 * Magic system request keys. Used for debugging...
135 */
136 extern int magic_sysrq_key(int ch);
137 #endif
138
139
140 /*
141 * Forware declarations...
142 */
143 static void mcfrs_change_speed(struct mcf_serial *info);
144 static void mcfrs_wait_until_sent(struct tty_struct *tty, int timeout);
145
146
147 static inline int serial_paranoia_check(struct mcf_serial *info,
148 char *name, const char *routine)
149 {
150 #ifdef SERIAL_PARANOIA_CHECK
151 static const char badmagic[] =
152 "MCFRS(warning): bad magic number for serial struct %s in %s\n";
153 static const char badinfo[] =
154 "MCFRS(warning): null mcf_serial for %s in %s\n";
155
156 if (!info) {
157 printk(badinfo, name, routine);
158 return 1;
159 }
160 if (info->magic != SERIAL_MAGIC) {
161 printk(badmagic, name, routine);
162 return 1;
163 }
164 #endif
165 return 0;
166 }
167
168 /*
169 * Sets or clears DTR and RTS on the requested line.
170 */
171 static void mcfrs_setsignals(struct mcf_serial *info, int dtr, int rts)
172 {
173 volatile unsigned char *uartp;
174 unsigned long flags;
175
176 #if 0
177 printk("%s(%d): mcfrs_setsignals(info=%x,dtr=%d,rts=%d)\n",
178 __FILE__, __LINE__, info, dtr, rts);
179 #endif
180
181 local_irq_save(flags);
182 if (dtr >= 0) {
183 #ifdef MCFPP_DTR0
184 if (info->line)
185 mcf_setppdata(MCFPP_DTR1, (dtr ? 0 : MCFPP_DTR1));
186 else
187 mcf_setppdata(MCFPP_DTR0, (dtr ? 0 : MCFPP_DTR0));
188 #endif
189 }
190 if (rts >= 0) {
191 uartp = info->addr;
192 if (rts) {
193 info->sigs |= TIOCM_RTS;
194 uartp[MCFUART_UOP1] = MCFUART_UOP_RTS;
195 } else {
196 info->sigs &= ~TIOCM_RTS;
197 uartp[MCFUART_UOP0] = MCFUART_UOP_RTS;
198 }
199 }
200 local_irq_restore(flags);
201 return;
202 }
203
204 /*
205 * Gets values of serial signals.
206 */
207 static int mcfrs_getsignals(struct mcf_serial *info)
208 {
209 volatile unsigned char *uartp;
210 unsigned long flags;
211 int sigs;
212 #if defined(CONFIG_NETtel) && defined(CONFIG_M5307)
213 unsigned short ppdata;
214 #endif
215
216 #if 0
217 printk("%s(%d): mcfrs_getsignals(info=%x)\n", __FILE__, __LINE__);
218 #endif
219
220 local_irq_save(flags);
221 uartp = info->addr;
222 sigs = (uartp[MCFUART_UIPR] & MCFUART_UIPR_CTS) ? 0 : TIOCM_CTS;
223 sigs |= (info->sigs & TIOCM_RTS);
224
225 #ifdef MCFPP_DCD0
226 {
227 unsigned int ppdata;
228 ppdata = mcf_getppdata();
229 if (info->line == 0) {
230 sigs |= (ppdata & MCFPP_DCD0) ? 0 : TIOCM_CD;
231 sigs |= (ppdata & MCFPP_DTR0) ? 0 : TIOCM_DTR;
232 } else if (info->line == 1) {
233 sigs |= (ppdata & MCFPP_DCD1) ? 0 : TIOCM_CD;
234 sigs |= (ppdata & MCFPP_DTR1) ? 0 : TIOCM_DTR;
235 }
236 }
237 #endif
238
239 local_irq_restore(flags);
240 return(sigs);
241 }
242
243 /*
244 * ------------------------------------------------------------
245 * mcfrs_stop() and mcfrs_start()
246 *
247 * This routines are called before setting or resetting tty->stopped.
248 * They enable or disable transmitter interrupts, as necessary.
249 * ------------------------------------------------------------
250 */
251 static void mcfrs_stop(struct tty_struct *tty)
252 {
253 volatile unsigned char *uartp;
254 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
255 unsigned long flags;
256
257 if (serial_paranoia_check(info, tty->name, "mcfrs_stop"))
258 return;
259
260 local_irq_save(flags);
261 uartp = info->addr;
262 info->imr &= ~MCFUART_UIR_TXREADY;
263 uartp[MCFUART_UIMR] = info->imr;
264 local_irq_restore(flags);
265 }
266
267 static void mcfrs_start(struct tty_struct *tty)
268 {
269 volatile unsigned char *uartp;
270 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
271 unsigned long flags;
272
273 if (serial_paranoia_check(info, tty->name, "mcfrs_start"))
274 return;
275
276 local_irq_save(flags);
277 if (info->xmit_cnt && info->xmit_buf) {
278 uartp = info->addr;
279 info->imr |= MCFUART_UIR_TXREADY;
280 uartp[MCFUART_UIMR] = info->imr;
281 }
282 local_irq_restore(flags);
283 }
284
285 /*
286 * ----------------------------------------------------------------------
287 *
288 * Here starts the interrupt handling routines. All of the following
289 * subroutines are declared as inline and are folded into
290 * mcfrs_interrupt(). They were separated out for readability's sake.
291 *
292 * Note: mcfrs_interrupt() is a "fast" interrupt, which means that it
293 * runs with interrupts turned off. People who may want to modify
294 * mcfrs_interrupt() should try to keep the interrupt handler as fast as
295 * possible. After you are done making modifications, it is not a bad
296 * idea to do:
297 *
298 * gcc -S -DKERNEL -Wall -Wstrict-prototypes -O6 -fomit-frame-pointer serial.c
299 *
300 * and look at the resulting assemble code in serial.s.
301 *
302 * - Ted Ts'o (tytso@mit.edu), 7-Mar-93
303 * -----------------------------------------------------------------------
304 */
305
306 static inline void receive_chars(struct mcf_serial *info)
307 {
308 volatile unsigned char *uartp;
309 struct tty_struct *tty = info->tty;
310 unsigned char status, ch;
311
312 if (!tty)
313 return;
314
315 uartp = info->addr;
316
317 while ((status = uartp[MCFUART_USR]) & MCFUART_USR_RXREADY) {
318
319 if (tty->flip.count >= TTY_FLIPBUF_SIZE)
320 break;
321
322 ch = uartp[MCFUART_URB];
323 info->stats.rx++;
324
325 #ifdef CONFIG_MAGIC_SYSRQ
326 if (mcfrs_console_inited && (info->line == mcfrs_console_port)) {
327 if (magic_sysrq_key(ch))
328 continue;
329 }
330 #endif
331
332 tty->flip.count++;
333 if (status & MCFUART_USR_RXERR) {
334 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETERR;
335 if (status & MCFUART_USR_RXBREAK) {
336 info->stats.rxbreak++;
337 *tty->flip.flag_buf_ptr++ = TTY_BREAK;
338 } else if (status & MCFUART_USR_RXPARITY) {
339 info->stats.rxparity++;
340 *tty->flip.flag_buf_ptr++ = TTY_PARITY;
341 } else if (status & MCFUART_USR_RXOVERRUN) {
342 info->stats.rxoverrun++;
343 *tty->flip.flag_buf_ptr++ = TTY_OVERRUN;
344 } else if (status & MCFUART_USR_RXFRAMING) {
345 info->stats.rxframing++;
346 *tty->flip.flag_buf_ptr++ = TTY_FRAME;
347 } else {
348 /* This should never happen... */
349 *tty->flip.flag_buf_ptr++ = 0;
350 }
351 } else {
352 *tty->flip.flag_buf_ptr++ = 0;
353 }
354 *tty->flip.char_buf_ptr++ = ch;
355 }
356
357 schedule_work(&tty->flip.work);
358 return;
359 }
360
361 static inline void transmit_chars(struct mcf_serial *info)
362 {
363 volatile unsigned char *uartp;
364
365 uartp = info->addr;
366
367 if (info->x_char) {
368 /* Send special char - probably flow control */
369 uartp[MCFUART_UTB] = info->x_char;
370 info->x_char = 0;
371 info->stats.tx++;
372 }
373
374 if ((info->xmit_cnt <= 0) || info->tty->stopped) {
375 info->imr &= ~MCFUART_UIR_TXREADY;
376 uartp[MCFUART_UIMR] = info->imr;
377 return;
378 }
379
380 while (uartp[MCFUART_USR] & MCFUART_USR_TXREADY) {
381 uartp[MCFUART_UTB] = info->xmit_buf[info->xmit_tail++];
382 info->xmit_tail = info->xmit_tail & (SERIAL_XMIT_SIZE-1);
383 info->stats.tx++;
384 if (--info->xmit_cnt <= 0)
385 break;
386 }
387
388 if (info->xmit_cnt < WAKEUP_CHARS)
389 schedule_work(&info->tqueue);
390 return;
391 }
392
393 /*
394 * This is the serial driver's generic interrupt routine
395 */
396 irqreturn_t mcfrs_interrupt(int irq, void *dev_id, struct pt_regs *regs)
397 {
398 struct mcf_serial *info;
399 unsigned char isr;
400
401 info = &mcfrs_table[(irq - IRQBASE)];
402 isr = info->addr[MCFUART_UISR] & info->imr;
403
404 if (isr & MCFUART_UIR_RXREADY)
405 receive_chars(info);
406 if (isr & MCFUART_UIR_TXREADY)
407 transmit_chars(info);
408 return IRQ_HANDLED;
409 }
410
411 /*
412 * -------------------------------------------------------------------
413 * Here ends the serial interrupt routines.
414 * -------------------------------------------------------------------
415 */
416
417 static void mcfrs_offintr(void *private)
418 {
419 struct mcf_serial *info = (struct mcf_serial *) private;
420 struct tty_struct *tty;
421
422 tty = info->tty;
423 if (!tty)
424 return;
425 tty_wakeup(tty);
426 }
427
428
429 /*
430 * Change of state on a DCD line.
431 */
432 void mcfrs_modem_change(struct mcf_serial *info, int dcd)
433 {
434 if (info->count == 0)
435 return;
436
437 if (info->flags & ASYNC_CHECK_CD) {
438 if (dcd)
439 wake_up_interruptible(&info->open_wait);
440 else
441 schedule_work(&info->tqueue_hangup);
442 }
443 }
444
445
446 #ifdef MCFPP_DCD0
447
448 unsigned short mcfrs_ppstatus;
449
450 /*
451 * This subroutine is called when the RS_TIMER goes off. It is used
452 * to monitor the state of the DCD lines - since they have no edge
453 * sensors and interrupt generators.
454 */
455 static void mcfrs_timer(void)
456 {
457 unsigned int ppstatus, dcdval, i;
458
459 ppstatus = mcf_getppdata() & (MCFPP_DCD0 | MCFPP_DCD1);
460
461 if (ppstatus != mcfrs_ppstatus) {
462 for (i = 0; (i < 2); i++) {
463 dcdval = (i ? MCFPP_DCD1 : MCFPP_DCD0);
464 if ((ppstatus & dcdval) != (mcfrs_ppstatus & dcdval)) {
465 mcfrs_modem_change(&mcfrs_table[i],
466 ((ppstatus & dcdval) ? 0 : 1));
467 }
468 }
469 }
470 mcfrs_ppstatus = ppstatus;
471
472 /* Re-arm timer */
473 mcfrs_timer_struct.expires = jiffies + HZ/25;
474 add_timer(&mcfrs_timer_struct);
475 }
476
477 #endif /* MCFPP_DCD0 */
478
479
480 /*
481 * This routine is called from the scheduler tqueue when the interrupt
482 * routine has signalled that a hangup has occurred. The path of
483 * hangup processing is:
484 *
485 * serial interrupt routine -> (scheduler tqueue) ->
486 * do_serial_hangup() -> tty->hangup() -> mcfrs_hangup()
487 *
488 */
489 static void do_serial_hangup(void *private)
490 {
491 struct mcf_serial *info = (struct mcf_serial *) private;
492 struct tty_struct *tty;
493
494 tty = info->tty;
495 if (!tty)
496 return;
497
498 tty_hangup(tty);
499 }
500
501 static int startup(struct mcf_serial * info)
502 {
503 volatile unsigned char *uartp;
504 unsigned long flags;
505
506 if (info->flags & ASYNC_INITIALIZED)
507 return 0;
508
509 if (!info->xmit_buf) {
510 info->xmit_buf = (unsigned char *) __get_free_page(GFP_KERNEL);
511 if (!info->xmit_buf)
512 return -ENOMEM;
513 }
514
515 local_irq_save(flags);
516
517 #ifdef SERIAL_DEBUG_OPEN
518 printk("starting up ttyS%d (irq %d)...\n", info->line, info->irq);
519 #endif
520
521 /*
522 * Reset UART, get it into known state...
523 */
524 uartp = info->addr;
525 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETRX; /* reset RX */
526 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETTX; /* reset TX */
527 mcfrs_setsignals(info, 1, 1);
528
529 if (info->tty)
530 clear_bit(TTY_IO_ERROR, &info->tty->flags);
531 info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
532
533 /*
534 * and set the speed of the serial port
535 */
536 mcfrs_change_speed(info);
537
538 /*
539 * Lastly enable the UART transmitter and receiver, and
540 * interrupt enables.
541 */
542 info->imr = MCFUART_UIR_RXREADY;
543 uartp[MCFUART_UCR] = MCFUART_UCR_RXENABLE | MCFUART_UCR_TXENABLE;
544 uartp[MCFUART_UIMR] = info->imr;
545
546 info->flags |= ASYNC_INITIALIZED;
547 local_irq_restore(flags);
548 return 0;
549 }
550
551 /*
552 * This routine will shutdown a serial port; interrupts are disabled, and
553 * DTR is dropped if the hangup on close termio flag is on.
554 */
555 static void shutdown(struct mcf_serial * info)
556 {
557 volatile unsigned char *uartp;
558 unsigned long flags;
559
560 if (!(info->flags & ASYNC_INITIALIZED))
561 return;
562
563 #ifdef SERIAL_DEBUG_OPEN
564 printk("Shutting down serial port %d (irq %d)....\n", info->line,
565 info->irq);
566 #endif
567
568 local_irq_save(flags);
569
570 uartp = info->addr;
571 uartp[MCFUART_UIMR] = 0; /* mask all interrupts */
572 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETRX; /* reset RX */
573 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETTX; /* reset TX */
574
575 if (!info->tty || (info->tty->termios->c_cflag & HUPCL))
576 mcfrs_setsignals(info, 0, 0);
577
578 if (info->xmit_buf) {
579 free_page((unsigned long) info->xmit_buf);
580 info->xmit_buf = 0;
581 }
582
583 if (info->tty)
584 set_bit(TTY_IO_ERROR, &info->tty->flags);
585
586 info->flags &= ~ASYNC_INITIALIZED;
587 local_irq_restore(flags);
588 }
589
590
591 /*
592 * This routine is called to set the UART divisor registers to match
593 * the specified baud rate for a serial port.
594 */
595 static void mcfrs_change_speed(struct mcf_serial *info)
596 {
597 volatile unsigned char *uartp;
598 unsigned int baudclk, cflag;
599 unsigned long flags;
600 unsigned char mr1, mr2;
601 int i;
602 #ifdef CONFIG_M5272
603 unsigned int fraction;
604 #endif
605
606 if (!info->tty || !info->tty->termios)
607 return;
608 cflag = info->tty->termios->c_cflag;
609 if (info->addr == 0)
610 return;
611
612 #if 0
613 printk("%s(%d): mcfrs_change_speed()\n", __FILE__, __LINE__);
614 #endif
615
616 i = cflag & CBAUD;
617 if (i & CBAUDEX) {
618 i &= ~CBAUDEX;
619 if (i < 1 || i > 4)
620 info->tty->termios->c_cflag &= ~CBAUDEX;
621 else
622 i += 15;
623 }
624 if (i == 0) {
625 mcfrs_setsignals(info, 0, -1);
626 return;
627 }
628
629 /* compute the baudrate clock */
630 #ifdef CONFIG_M5272
631 /*
632 * For the MCF5272, also compute the baudrate fraction.
633 */
634 baudclk = (MCF_BUSCLK / mcfrs_baud_table[i]) / 32;
635 fraction = MCF_BUSCLK - (baudclk * 32 * mcfrs_baud_table[i]);
636 fraction *= 16;
637 fraction /= (32 * mcfrs_baud_table[i]);
638 #else
639 baudclk = ((MCF_BUSCLK / mcfrs_baud_table[i]) + 16) / 32;
640 #endif
641
642 info->baud = mcfrs_baud_table[i];
643
644 mr1 = MCFUART_MR1_RXIRQRDY | MCFUART_MR1_RXERRCHAR;
645 mr2 = 0;
646
647 switch (cflag & CSIZE) {
648 case CS5: mr1 |= MCFUART_MR1_CS5; break;
649 case CS6: mr1 |= MCFUART_MR1_CS6; break;
650 case CS7: mr1 |= MCFUART_MR1_CS7; break;
651 case CS8:
652 default: mr1 |= MCFUART_MR1_CS8; break;
653 }
654
655 if (cflag & PARENB) {
656 if (cflag & CMSPAR) {
657 if (cflag & PARODD)
658 mr1 |= MCFUART_MR1_PARITYMARK;
659 else
660 mr1 |= MCFUART_MR1_PARITYSPACE;
661 } else {
662 if (cflag & PARODD)
663 mr1 |= MCFUART_MR1_PARITYODD;
664 else
665 mr1 |= MCFUART_MR1_PARITYEVEN;
666 }
667 } else {
668 mr1 |= MCFUART_MR1_PARITYNONE;
669 }
670
671 if (cflag & CSTOPB)
672 mr2 |= MCFUART_MR2_STOP2;
673 else
674 mr2 |= MCFUART_MR2_STOP1;
675
676 if (cflag & CRTSCTS) {
677 mr1 |= MCFUART_MR1_RXRTS;
678 mr2 |= MCFUART_MR2_TXCTS;
679 }
680
681 if (cflag & CLOCAL)
682 info->flags &= ~ASYNC_CHECK_CD;
683 else
684 info->flags |= ASYNC_CHECK_CD;
685
686 uartp = info->addr;
687
688 local_irq_save(flags);
689 #if 0
690 printk("%s(%d): mr1=%x mr2=%x baudclk=%x\n", __FILE__, __LINE__,
691 mr1, mr2, baudclk);
692 #endif
693 /*
694 Note: pg 12-16 of MCF5206e User's Manual states that a
695 software reset should be performed prior to changing
696 UMR1,2, UCSR, UACR, bit 7
697 */
698 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETRX; /* reset RX */
699 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETTX; /* reset TX */
700 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETMRPTR; /* reset MR pointer */
701 uartp[MCFUART_UMR] = mr1;
702 uartp[MCFUART_UMR] = mr2;
703 uartp[MCFUART_UBG1] = (baudclk & 0xff00) >> 8; /* set msb byte */
704 uartp[MCFUART_UBG2] = (baudclk & 0xff); /* set lsb byte */
705 #ifdef CONFIG_M5272
706 uartp[MCFUART_UFPD] = (fraction & 0xf); /* set fraction */
707 #endif
708 uartp[MCFUART_UCSR] = MCFUART_UCSR_RXCLKTIMER | MCFUART_UCSR_TXCLKTIMER;
709 uartp[MCFUART_UCR] = MCFUART_UCR_RXENABLE | MCFUART_UCR_TXENABLE;
710 mcfrs_setsignals(info, 1, -1);
711 local_irq_restore(flags);
712 return;
713 }
714
715 static void mcfrs_flush_chars(struct tty_struct *tty)
716 {
717 volatile unsigned char *uartp;
718 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
719 unsigned long flags;
720
721 if (serial_paranoia_check(info, tty->name, "mcfrs_flush_chars"))
722 return;
723
724 uartp = (volatile unsigned char *) info->addr;
725
726 /*
727 * re-enable receiver interrupt
728 */
729 local_irq_save(flags);
730 if ((!(info->imr & MCFUART_UIR_RXREADY)) &&
731 (info->flags & ASYNC_INITIALIZED) ) {
732 info->imr |= MCFUART_UIR_RXREADY;
733 uartp[MCFUART_UIMR] = info->imr;
734 }
735 local_irq_restore(flags);
736
737 if (info->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped ||
738 !info->xmit_buf)
739 return;
740
741 /* Enable transmitter */
742 local_irq_save(flags);
743 info->imr |= MCFUART_UIR_TXREADY;
744 uartp[MCFUART_UIMR] = info->imr;
745 local_irq_restore(flags);
746 }
747
748 static int mcfrs_write(struct tty_struct * tty,
749 const unsigned char *buf, int count)
750 {
751 volatile unsigned char *uartp;
752 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
753 unsigned long flags;
754 int c, total = 0;
755
756 #if 0
757 printk("%s(%d): mcfrs_write(tty=%x,buf=%x,count=%d)\n",
758 __FILE__, __LINE__, (int)tty, (int)buf, count);
759 #endif
760
761 if (serial_paranoia_check(info, tty->name, "mcfrs_write"))
762 return 0;
763
764 if (!tty || !info->xmit_buf)
765 return 0;
766
767 local_save_flags(flags);
768 while (1) {
769 local_irq_disable();
770 c = min(count, (int) min(((int)SERIAL_XMIT_SIZE) - info->xmit_cnt - 1,
771 ((int)SERIAL_XMIT_SIZE) - info->xmit_head));
772 local_irq_restore(flags);
773
774 if (c <= 0)
775 break;
776
777 memcpy(info->xmit_buf + info->xmit_head, buf, c);
778
779 local_irq_disable();
780 info->xmit_head = (info->xmit_head + c) & (SERIAL_XMIT_SIZE-1);
781 info->xmit_cnt += c;
782 local_irq_restore(flags);
783
784 buf += c;
785 count -= c;
786 total += c;
787 }
788
789 local_irq_disable();
790 uartp = info->addr;
791 info->imr |= MCFUART_UIR_TXREADY;
792 uartp[MCFUART_UIMR] = info->imr;
793 local_irq_restore(flags);
794
795 return total;
796 }
797
798 static int mcfrs_write_room(struct tty_struct *tty)
799 {
800 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
801 int ret;
802
803 if (serial_paranoia_check(info, tty->name, "mcfrs_write_room"))
804 return 0;
805 ret = SERIAL_XMIT_SIZE - info->xmit_cnt - 1;
806 if (ret < 0)
807 ret = 0;
808 return ret;
809 }
810
811 static int mcfrs_chars_in_buffer(struct tty_struct *tty)
812 {
813 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
814
815 if (serial_paranoia_check(info, tty->name, "mcfrs_chars_in_buffer"))
816 return 0;
817 return info->xmit_cnt;
818 }
819
820 static void mcfrs_flush_buffer(struct tty_struct *tty)
821 {
822 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
823 unsigned long flags;
824
825 if (serial_paranoia_check(info, tty->name, "mcfrs_flush_buffer"))
826 return;
827
828 local_irq_save(flags);
829 info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
830 local_irq_restore(flags);
831
832 tty_wakeup(tty);
833 }
834
835 /*
836 * ------------------------------------------------------------
837 * mcfrs_throttle()
838 *
839 * This routine is called by the upper-layer tty layer to signal that
840 * incoming characters should be throttled.
841 * ------------------------------------------------------------
842 */
843 static void mcfrs_throttle(struct tty_struct * tty)
844 {
845 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
846 #ifdef SERIAL_DEBUG_THROTTLE
847 char buf[64];
848
849 printk("throttle %s: %d....\n", _tty_name(tty, buf),
850 tty->ldisc.chars_in_buffer(tty));
851 #endif
852
853 if (serial_paranoia_check(info, tty->name, "mcfrs_throttle"))
854 return;
855
856 if (I_IXOFF(tty))
857 info->x_char = STOP_CHAR(tty);
858
859 /* Turn off RTS line (do this atomic) */
860 }
861
862 static void mcfrs_unthrottle(struct tty_struct * tty)
863 {
864 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
865 #ifdef SERIAL_DEBUG_THROTTLE
866 char buf[64];
867
868 printk("unthrottle %s: %d....\n", _tty_name(tty, buf),
869 tty->ldisc.chars_in_buffer(tty));
870 #endif
871
872 if (serial_paranoia_check(info, tty->name, "mcfrs_unthrottle"))
873 return;
874
875 if (I_IXOFF(tty)) {
876 if (info->x_char)
877 info->x_char = 0;
878 else
879 info->x_char = START_CHAR(tty);
880 }
881
882 /* Assert RTS line (do this atomic) */
883 }
884
885 /*
886 * ------------------------------------------------------------
887 * mcfrs_ioctl() and friends
888 * ------------------------------------------------------------
889 */
890
891 static int get_serial_info(struct mcf_serial * info,
892 struct serial_struct * retinfo)
893 {
894 struct serial_struct tmp;
895
896 if (!retinfo)
897 return -EFAULT;
898 memset(&tmp, 0, sizeof(tmp));
899 tmp.type = info->type;
900 tmp.line = info->line;
901 tmp.port = (unsigned int) info->addr;
902 tmp.irq = info->irq;
903 tmp.flags = info->flags;
904 tmp.baud_base = info->baud_base;
905 tmp.close_delay = info->close_delay;
906 tmp.closing_wait = info->closing_wait;
907 tmp.custom_divisor = info->custom_divisor;
908 return copy_to_user(retinfo,&tmp,sizeof(*retinfo)) ? -EFAULT : 0;
909 }
910
911 static int set_serial_info(struct mcf_serial * info,
912 struct serial_struct * new_info)
913 {
914 struct serial_struct new_serial;
915 struct mcf_serial old_info;
916 int retval = 0;
917
918 if (!new_info)
919 return -EFAULT;
920 if (copy_from_user(&new_serial,new_info,sizeof(new_serial)))
921 return -EFAULT;
922 old_info = *info;
923
924 if (!capable(CAP_SYS_ADMIN)) {
925 if ((new_serial.baud_base != info->baud_base) ||
926 (new_serial.type != info->type) ||
927 (new_serial.close_delay != info->close_delay) ||
928 ((new_serial.flags & ~ASYNC_USR_MASK) !=
929 (info->flags & ~ASYNC_USR_MASK)))
930 return -EPERM;
931 info->flags = ((info->flags & ~ASYNC_USR_MASK) |
932 (new_serial.flags & ASYNC_USR_MASK));
933 info->custom_divisor = new_serial.custom_divisor;
934 goto check_and_exit;
935 }
936
937 if (info->count > 1)
938 return -EBUSY;
939
940 /*
941 * OK, past this point, all the error checking has been done.
942 * At this point, we start making changes.....
943 */
944
945 info->baud_base = new_serial.baud_base;
946 info->flags = ((info->flags & ~ASYNC_FLAGS) |
947 (new_serial.flags & ASYNC_FLAGS));
948 info->type = new_serial.type;
949 info->close_delay = new_serial.close_delay;
950 info->closing_wait = new_serial.closing_wait;
951
952 check_and_exit:
953 retval = startup(info);
954 return retval;
955 }
956
957 /*
958 * get_lsr_info - get line status register info
959 *
960 * Purpose: Let user call ioctl() to get info when the UART physically
961 * is emptied. On bus types like RS485, the transmitter must
962 * release the bus after transmitting. This must be done when
963 * the transmit shift register is empty, not be done when the
964 * transmit holding register is empty. This functionality
965 * allows an RS485 driver to be written in user space.
966 */
967 static int get_lsr_info(struct mcf_serial * info, unsigned int *value)
968 {
969 volatile unsigned char *uartp;
970 unsigned long flags;
971 unsigned char status;
972
973 local_irq_save(flags);
974 uartp = info->addr;
975 status = (uartp[MCFUART_USR] & MCFUART_USR_TXEMPTY) ? TIOCSER_TEMT : 0;
976 local_irq_restore(flags);
977
978 return put_user(status,value);
979 }
980
981 /*
982 * This routine sends a break character out the serial port.
983 */
984 static void send_break( struct mcf_serial * info, int duration)
985 {
986 volatile unsigned char *uartp;
987 unsigned long flags;
988
989 if (!info->addr)
990 return;
991 set_current_state(TASK_INTERRUPTIBLE);
992 uartp = info->addr;
993
994 local_irq_save(flags);
995 uartp[MCFUART_UCR] = MCFUART_UCR_CMDBREAKSTART;
996 schedule_timeout(duration);
997 uartp[MCFUART_UCR] = MCFUART_UCR_CMDBREAKSTOP;
998 local_irq_restore(flags);
999 }
1000
1001 static int mcfrs_tiocmget(struct tty_struct *tty, struct file *file)
1002 {
1003 struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
1004
1005 if (serial_paranoia_check(info, tty->name, "mcfrs_ioctl"))
1006 return -ENODEV;
1007 if (tty->flags & (1 << TTY_IO_ERROR))
1008 return -EIO;
1009
1010 return mcfrs_getsignals(info);
1011 }
1012
1013 static int mcfrs_tiocmset(struct tty_struct *tty, struct file *file,
1014 unsigned int set, unsigned int clear)
1015 {
1016 struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
1017 int rts = -1, dtr = -1;
1018
1019 if (serial_paranoia_check(info, tty->name, "mcfrs_ioctl"))
1020 return -ENODEV;
1021 if (tty->flags & (1 << TTY_IO_ERROR))
1022 return -EIO;
1023
1024 if (set & TIOCM_RTS)
1025 rts = 1;
1026 if (set & TIOCM_DTR)
1027 dtr = 1;
1028 if (clear & TIOCM_RTS)
1029 rts = 0;
1030 if (clear & TIOCM_DTR)
1031 dtr = 0;
1032
1033 mcfrs_setsignals(info, dtr, rts);
1034
1035 return 0;
1036 }
1037
1038 static int mcfrs_ioctl(struct tty_struct *tty, struct file * file,
1039 unsigned int cmd, unsigned long arg)
1040 {
1041 struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
1042 int retval, error;
1043
1044 if (serial_paranoia_check(info, tty->name, "mcfrs_ioctl"))
1045 return -ENODEV;
1046
1047 if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
1048 (cmd != TIOCSERCONFIG) && (cmd != TIOCSERGWILD) &&
1049 (cmd != TIOCSERSWILD) && (cmd != TIOCSERGSTRUCT)) {
1050 if (tty->flags & (1 << TTY_IO_ERROR))
1051 return -EIO;
1052 }
1053
1054 switch (cmd) {
1055 case TCSBRK: /* SVID version: non-zero arg --> no break */
1056 retval = tty_check_change(tty);
1057 if (retval)
1058 return retval;
1059 tty_wait_until_sent(tty, 0);
1060 if (!arg)
1061 send_break(info, HZ/4); /* 1/4 second */
1062 return 0;
1063 case TCSBRKP: /* support for POSIX tcsendbreak() */
1064 retval = tty_check_change(tty);
1065 if (retval)
1066 return retval;
1067 tty_wait_until_sent(tty, 0);
1068 send_break(info, arg ? arg*(HZ/10) : HZ/4);
1069 return 0;
1070 case TIOCGSOFTCAR:
1071 error = put_user(C_CLOCAL(tty) ? 1 : 0,
1072 (unsigned long *) arg);
1073 if (error)
1074 return error;
1075 return 0;
1076 case TIOCSSOFTCAR:
1077 get_user(arg, (unsigned long *) arg);
1078 tty->termios->c_cflag =
1079 ((tty->termios->c_cflag & ~CLOCAL) |
1080 (arg ? CLOCAL : 0));
1081 return 0;
1082 case TIOCGSERIAL:
1083 if (access_ok(VERIFY_WRITE, (void *) arg,
1084 sizeof(struct serial_struct)))
1085 return get_serial_info(info,
1086 (struct serial_struct *) arg);
1087 return -EFAULT;
1088 case TIOCSSERIAL:
1089 return set_serial_info(info,
1090 (struct serial_struct *) arg);
1091 case TIOCSERGETLSR: /* Get line status register */
1092 if (access_ok(VERIFY_WRITE, (void *) arg,
1093 sizeof(unsigned int)))
1094 return get_lsr_info(info, (unsigned int *) arg);
1095 return -EFAULT;
1096 case TIOCSERGSTRUCT:
1097 error = copy_to_user((struct mcf_serial *) arg,
1098 info, sizeof(struct mcf_serial));
1099 if (error)
1100 return -EFAULT;
1101 return 0;
1102
1103 #ifdef TIOCSET422
1104 case TIOCSET422: {
1105 unsigned int val;
1106 get_user(val, (unsigned int *) arg);
1107 mcf_setpa(MCFPP_PA11, (val ? 0 : MCFPP_PA11));
1108 break;
1109 }
1110 case TIOCGET422: {
1111 unsigned int val;
1112 val = (mcf_getpa() & MCFPP_PA11) ? 0 : 1;
1113 put_user(val, (unsigned int *) arg);
1114 break;
1115 }
1116 #endif
1117
1118 default:
1119 return -ENOIOCTLCMD;
1120 }
1121 return 0;
1122 }
1123
1124 static void mcfrs_set_termios(struct tty_struct *tty, struct termios *old_termios)
1125 {
1126 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
1127
1128 if (tty->termios->c_cflag == old_termios->c_cflag)
1129 return;
1130
1131 mcfrs_change_speed(info);
1132
1133 if ((old_termios->c_cflag & CRTSCTS) &&
1134 !(tty->termios->c_cflag & CRTSCTS)) {
1135 tty->hw_stopped = 0;
1136 mcfrs_setsignals(info, -1, 1);
1137 #if 0
1138 mcfrs_start(tty);
1139 #endif
1140 }
1141 }
1142
1143 /*
1144 * ------------------------------------------------------------
1145 * mcfrs_close()
1146 *
1147 * This routine is called when the serial port gets closed. First, we
1148 * wait for the last remaining data to be sent. Then, we unlink its
1149 * S structure from the interrupt chain if necessary, and we free
1150 * that IRQ if nothing is left in the chain.
1151 * ------------------------------------------------------------
1152 */
1153 static void mcfrs_close(struct tty_struct *tty, struct file * filp)
1154 {
1155 volatile unsigned char *uartp;
1156 struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
1157 unsigned long flags;
1158
1159 if (!info || serial_paranoia_check(info, tty->name, "mcfrs_close"))
1160 return;
1161
1162 local_irq_save(flags);
1163
1164 if (tty_hung_up_p(filp)) {
1165 local_irq_restore(flags);
1166 return;
1167 }
1168
1169 #ifdef SERIAL_DEBUG_OPEN
1170 printk("mcfrs_close ttyS%d, count = %d\n", info->line, info->count);
1171 #endif
1172 if ((tty->count == 1) && (info->count != 1)) {
1173 /*
1174 * Uh, oh. tty->count is 1, which means that the tty
1175 * structure will be freed. Info->count should always
1176 * be one in these conditions. If it's greater than
1177 * one, we've got real problems, since it means the
1178 * serial port won't be shutdown.
1179 */
1180 printk("MCFRS: bad serial port count; tty->count is 1, "
1181 "info->count is %d\n", info->count);
1182 info->count = 1;
1183 }
1184 if (--info->count < 0) {
1185 printk("MCFRS: bad serial port count for ttyS%d: %d\n",
1186 info->line, info->count);
1187 info->count = 0;
1188 }
1189 if (info->count) {
1190 local_irq_restore(flags);
1191 return;
1192 }
1193 info->flags |= ASYNC_CLOSING;
1194
1195 /*
1196 * Now we wait for the transmit buffer to clear; and we notify
1197 * the line discipline to only process XON/XOFF characters.
1198 */
1199 tty->closing = 1;
1200 if (info->closing_wait != ASYNC_CLOSING_WAIT_NONE)
1201 tty_wait_until_sent(tty, info->closing_wait);
1202
1203 /*
1204 * At this point we stop accepting input. To do this, we
1205 * disable the receive line status interrupts, and tell the
1206 * interrupt driver to stop checking the data ready bit in the
1207 * line status register.
1208 */
1209 info->imr &= ~MCFUART_UIR_RXREADY;
1210 uartp = info->addr;
1211 uartp[MCFUART_UIMR] = info->imr;
1212
1213 #if 0
1214 /* FIXME: do we need to keep this enabled for console?? */
1215 if (mcfrs_console_inited && (mcfrs_console_port == info->line)) {
1216 /* Do not disable the UART */ ;
1217 } else
1218 #endif
1219 shutdown(info);
1220 if (tty->driver->flush_buffer)
1221 tty->driver->flush_buffer(tty);
1222 tty_ldisc_flush(tty);
1223
1224 tty->closing = 0;
1225 info->event = 0;
1226 info->tty = 0;
1227 #if 0
1228 if (tty->ldisc.num != ldiscs[N_TTY].num) {
1229 if (tty->ldisc.close)
1230 (tty->ldisc.close)(tty);
1231 tty->ldisc = ldiscs[N_TTY];
1232 tty->termios->c_line = N_TTY;
1233 if (tty->ldisc.open)
1234 (tty->ldisc.open)(tty);
1235 }
1236 #endif
1237 if (info->blocked_open) {
1238 if (info->close_delay) {
1239 msleep_interruptible(jiffies_to_msecs(info->close_delay));
1240 }
1241 wake_up_interruptible(&info->open_wait);
1242 }
1243 info->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING);
1244 wake_up_interruptible(&info->close_wait);
1245 local_irq_restore(flags);
1246 }
1247
1248 /*
1249 * mcfrs_wait_until_sent() --- wait until the transmitter is empty
1250 */
1251 static void
1252 mcfrs_wait_until_sent(struct tty_struct *tty, int timeout)
1253 {
1254 #ifdef CONFIG_M5272
1255 #define MCF5272_FIFO_SIZE 25 /* fifo size + shift reg */
1256
1257 struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
1258 volatile unsigned char *uartp;
1259 unsigned long orig_jiffies, fifo_time, char_time, fifo_cnt;
1260
1261 if (serial_paranoia_check(info, tty->name, "mcfrs_wait_until_sent"))
1262 return;
1263
1264 orig_jiffies = jiffies;
1265
1266 /*
1267 * Set the check interval to be 1/5 of the approximate time
1268 * to send the entire fifo, and make it at least 1. The check
1269 * interval should also be less than the timeout.
1270 *
1271 * Note: we have to use pretty tight timings here to satisfy
1272 * the NIST-PCTS.
1273 */
1274 fifo_time = (MCF5272_FIFO_SIZE * HZ * 10) / info->baud;
1275 char_time = fifo_time / 5;
1276 if (char_time == 0)
1277 char_time = 1;
1278 if (timeout && timeout < char_time)
1279 char_time = timeout;
1280
1281 /*
1282 * Clamp the timeout period at 2 * the time to empty the
1283 * fifo. Just to be safe, set the minimum at .5 seconds.
1284 */
1285 fifo_time *= 2;
1286 if (fifo_time < (HZ/2))
1287 fifo_time = HZ/2;
1288 if (!timeout || timeout > fifo_time)
1289 timeout = fifo_time;
1290
1291 /*
1292 * Account for the number of bytes in the UART
1293 * transmitter FIFO plus any byte being shifted out.
1294 */
1295 uartp = (volatile unsigned char *) info->addr;
1296 for (;;) {
1297 fifo_cnt = (uartp[MCFUART_UTF] & MCFUART_UTF_TXB);
1298 if ((uartp[MCFUART_USR] & (MCFUART_USR_TXREADY|
1299 MCFUART_USR_TXEMPTY)) ==
1300 MCFUART_USR_TXREADY)
1301 fifo_cnt++;
1302 if (fifo_cnt == 0)
1303 break;
1304 msleep_interruptible(jiffies_to_msecs(char_time));
1305 if (signal_pending(current))
1306 break;
1307 if (timeout && time_after(jiffies, orig_jiffies + timeout))
1308 break;
1309 }
1310 #else
1311 /*
1312 * For the other coldfire models, assume all data has been sent
1313 */
1314 #endif
1315 }
1316
1317 /*
1318 * mcfrs_hangup() --- called by tty_hangup() when a hangup is signaled.
1319 */
1320 void mcfrs_hangup(struct tty_struct *tty)
1321 {
1322 struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
1323
1324 if (serial_paranoia_check(info, tty->name, "mcfrs_hangup"))
1325 return;
1326
1327 mcfrs_flush_buffer(tty);
1328 shutdown(info);
1329 info->event = 0;
1330 info->count = 0;
1331 info->flags &= ~ASYNC_NORMAL_ACTIVE;
1332 info->tty = 0;
1333 wake_up_interruptible(&info->open_wait);
1334 }
1335
1336 /*
1337 * ------------------------------------------------------------
1338 * mcfrs_open() and friends
1339 * ------------------------------------------------------------
1340 */
1341 static int block_til_ready(struct tty_struct *tty, struct file * filp,
1342 struct mcf_serial *info)
1343 {
1344 DECLARE_WAITQUEUE(wait, current);
1345 int retval;
1346 int do_clocal = 0;
1347
1348 /*
1349 * If the device is in the middle of being closed, then block
1350 * until it's done, and then try again.
1351 */
1352 if (info->flags & ASYNC_CLOSING) {
1353 interruptible_sleep_on(&info->close_wait);
1354 #ifdef SERIAL_DO_RESTART
1355 if (info->flags & ASYNC_HUP_NOTIFY)
1356 return -EAGAIN;
1357 else
1358 return -ERESTARTSYS;
1359 #else
1360 return -EAGAIN;
1361 #endif
1362 }
1363
1364 /*
1365 * If non-blocking mode is set, or the port is not enabled,
1366 * then make the check up front and then exit.
1367 */
1368 if ((filp->f_flags & O_NONBLOCK) ||
1369 (tty->flags & (1 << TTY_IO_ERROR))) {
1370 info->flags |= ASYNC_NORMAL_ACTIVE;
1371 return 0;
1372 }
1373
1374 if (tty->termios->c_cflag & CLOCAL)
1375 do_clocal = 1;
1376
1377 /*
1378 * Block waiting for the carrier detect and the line to become
1379 * free (i.e., not in use by the callout). While we are in
1380 * this loop, info->count is dropped by one, so that
1381 * mcfrs_close() knows when to free things. We restore it upon
1382 * exit, either normal or abnormal.
1383 */
1384 retval = 0;
1385 add_wait_queue(&info->open_wait, &wait);
1386 #ifdef SERIAL_DEBUG_OPEN
1387 printk("block_til_ready before block: ttyS%d, count = %d\n",
1388 info->line, info->count);
1389 #endif
1390 info->count--;
1391 info->blocked_open++;
1392 while (1) {
1393 local_irq_disable();
1394 mcfrs_setsignals(info, 1, 1);
1395 local_irq_enable();
1396 current->state = TASK_INTERRUPTIBLE;
1397 if (tty_hung_up_p(filp) ||
1398 !(info->flags & ASYNC_INITIALIZED)) {
1399 #ifdef SERIAL_DO_RESTART
1400 if (info->flags & ASYNC_HUP_NOTIFY)
1401 retval = -EAGAIN;
1402 else
1403 retval = -ERESTARTSYS;
1404 #else
1405 retval = -EAGAIN;
1406 #endif
1407 break;
1408 }
1409 if (!(info->flags & ASYNC_CLOSING) &&
1410 (do_clocal || (mcfrs_getsignals(info) & TIOCM_CD)))
1411 break;
1412 if (signal_pending(current)) {
1413 retval = -ERESTARTSYS;
1414 break;
1415 }
1416 #ifdef SERIAL_DEBUG_OPEN
1417 printk("block_til_ready blocking: ttyS%d, count = %d\n",
1418 info->line, info->count);
1419 #endif
1420 schedule();
1421 }
1422 current->state = TASK_RUNNING;
1423 remove_wait_queue(&info->open_wait, &wait);
1424 if (!tty_hung_up_p(filp))
1425 info->count++;
1426 info->blocked_open--;
1427 #ifdef SERIAL_DEBUG_OPEN
1428 printk("block_til_ready after blocking: ttyS%d, count = %d\n",
1429 info->line, info->count);
1430 #endif
1431 if (retval)
1432 return retval;
1433 info->flags |= ASYNC_NORMAL_ACTIVE;
1434 return 0;
1435 }
1436
1437 /*
1438 * This routine is called whenever a serial port is opened. It
1439 * enables interrupts for a serial port, linking in its structure into
1440 * the IRQ chain. It also performs the serial-specific
1441 * initialization for the tty structure.
1442 */
1443 int mcfrs_open(struct tty_struct *tty, struct file * filp)
1444 {
1445 struct mcf_serial *info;
1446 int retval, line;
1447
1448 line = tty->index;
1449 if ((line < 0) || (line >= NR_PORTS))
1450 return -ENODEV;
1451 info = mcfrs_table + line;
1452 if (serial_paranoia_check(info, tty->name, "mcfrs_open"))
1453 return -ENODEV;
1454 #ifdef SERIAL_DEBUG_OPEN
1455 printk("mcfrs_open %s, count = %d\n", tty->name, info->count);
1456 #endif
1457 info->count++;
1458 tty->driver_data = info;
1459 info->tty = tty;
1460
1461 /*
1462 * Start up serial port
1463 */
1464 retval = startup(info);
1465 if (retval)
1466 return retval;
1467
1468 retval = block_til_ready(tty, filp, info);
1469 if (retval) {
1470 #ifdef SERIAL_DEBUG_OPEN
1471 printk("mcfrs_open returning after block_til_ready with %d\n",
1472 retval);
1473 #endif
1474 return retval;
1475 }
1476
1477 #ifdef SERIAL_DEBUG_OPEN
1478 printk("mcfrs_open %s successful...\n", tty->name);
1479 #endif
1480 return 0;
1481 }
1482
1483 /*
1484 * Based on the line number set up the internal interrupt stuff.
1485 */
1486 static void mcfrs_irqinit(struct mcf_serial *info)
1487 {
1488 #if defined(CONFIG_M5272)
1489 volatile unsigned long *icrp;
1490 volatile unsigned long *portp;
1491 volatile unsigned char *uartp;
1492
1493 uartp = info->addr;
1494 icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR2);
1495
1496 switch (info->line) {
1497 case 0:
1498 *icrp = 0xe0000000;
1499 break;
1500 case 1:
1501 *icrp = 0x0e000000;
1502 break;
1503 default:
1504 printk("MCFRS: don't know how to handle UART %d interrupt?\n",
1505 info->line);
1506 return;
1507 }
1508
1509 /* Enable the output lines for the serial ports */
1510 portp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_PBCNT);
1511 *portp = (*portp & ~0x000000ff) | 0x00000055;
1512 portp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_PDCNT);
1513 *portp = (*portp & ~0x000003fc) | 0x000002a8;
1514 #elif defined(CONFIG_M527x) || defined(CONFIG_M528x)
1515 volatile unsigned char *icrp, *uartp;
1516 volatile unsigned long *imrp;
1517
1518 uartp = info->addr;
1519
1520 icrp = (volatile unsigned char *) (MCF_MBAR + MCFICM_INTC0 +
1521 MCFINTC_ICR0 + MCFINT_UART0 + info->line);
1522 *icrp = 0x33; /* UART0 with level 6, priority 3 */
1523
1524 imrp = (volatile unsigned long *) (MCF_MBAR + MCFICM_INTC0 +
1525 MCFINTC_IMRL);
1526 *imrp &= ~((1 << (info->irq - MCFINT_VECBASE)) | 1);
1527 #else
1528 volatile unsigned char *icrp, *uartp;
1529
1530 switch (info->line) {
1531 case 0:
1532 icrp = (volatile unsigned char *) (MCF_MBAR + MCFSIM_UART1ICR);
1533 *icrp = /*MCFSIM_ICR_AUTOVEC |*/ MCFSIM_ICR_LEVEL6 |
1534 MCFSIM_ICR_PRI1;
1535 mcf_setimr(mcf_getimr() & ~MCFSIM_IMR_UART1);
1536 break;
1537 case 1:
1538 icrp = (volatile unsigned char *) (MCF_MBAR + MCFSIM_UART2ICR);
1539 *icrp = /*MCFSIM_ICR_AUTOVEC |*/ MCFSIM_ICR_LEVEL6 |
1540 MCFSIM_ICR_PRI2;
1541 mcf_setimr(mcf_getimr() & ~MCFSIM_IMR_UART2);
1542 break;
1543 default:
1544 printk("MCFRS: don't know how to handle UART %d interrupt?\n",
1545 info->line);
1546 return;
1547 }
1548
1549 uartp = info->addr;
1550 uartp[MCFUART_UIVR] = info->irq;
1551 #endif
1552
1553 /* Clear mask, so no surprise interrupts. */
1554 uartp[MCFUART_UIMR] = 0;
1555
1556 if (request_irq(info->irq, mcfrs_interrupt, SA_INTERRUPT,
1557 "ColdFire UART", NULL)) {
1558 printk("MCFRS: Unable to attach ColdFire UART %d interrupt "
1559 "vector=%d\n", info->line, info->irq);
1560 }
1561
1562 return;
1563 }
1564
1565
1566 char *mcfrs_drivername = "ColdFire internal UART serial driver version 1.00\n";
1567
1568
1569 /*
1570 * Serial stats reporting...
1571 */
1572 int mcfrs_readproc(char *page, char **start, off_t off, int count,
1573 int *eof, void *data)
1574 {
1575 struct mcf_serial *info;
1576 char str[20];
1577 int len, sigs, i;
1578
1579 len = sprintf(page, mcfrs_drivername);
1580 for (i = 0; (i < NR_PORTS); i++) {
1581 info = &mcfrs_table[i];
1582 len += sprintf((page + len), "%d: port:%x irq=%d baud:%d ",
1583 i, (unsigned int) info->addr, info->irq, info->baud);
1584 if (info->stats.rx || info->stats.tx)
1585 len += sprintf((page + len), "tx:%d rx:%d ",
1586 info->stats.tx, info->stats.rx);
1587 if (info->stats.rxframing)
1588 len += sprintf((page + len), "fe:%d ",
1589 info->stats.rxframing);
1590 if (info->stats.rxparity)
1591 len += sprintf((page + len), "pe:%d ",
1592 info->stats.rxparity);
1593 if (info->stats.rxbreak)
1594 len += sprintf((page + len), "brk:%d ",
1595 info->stats.rxbreak);
1596 if (info->stats.rxoverrun)
1597 len += sprintf((page + len), "oe:%d ",
1598 info->stats.rxoverrun);
1599
1600 str[0] = str[1] = 0;
1601 if ((sigs = mcfrs_getsignals(info))) {
1602 if (sigs & TIOCM_RTS)
1603 strcat(str, "|RTS");
1604 if (sigs & TIOCM_CTS)
1605 strcat(str, "|CTS");
1606 if (sigs & TIOCM_DTR)
1607 strcat(str, "|DTR");
1608 if (sigs & TIOCM_CD)
1609 strcat(str, "|CD");
1610 }
1611
1612 len += sprintf((page + len), "%s\n", &str[1]);
1613 }
1614
1615 return(len);
1616 }
1617
1618
1619 /* Finally, routines used to initialize the serial driver. */
1620
1621 static void show_serial_version(void)
1622 {
1623 printk(mcfrs_drivername);
1624 }
1625
1626 static struct tty_operations mcfrs_ops = {
1627 .open = mcfrs_open,
1628 .close = mcfrs_close,
1629 .write = mcfrs_write,
1630 .flush_chars = mcfrs_flush_chars,
1631 .write_room = mcfrs_write_room,
1632 .chars_in_buffer = mcfrs_chars_in_buffer,
1633 .flush_buffer = mcfrs_flush_buffer,
1634 .ioctl = mcfrs_ioctl,
1635 .throttle = mcfrs_throttle,
1636 .unthrottle = mcfrs_unthrottle,
1637 .set_termios = mcfrs_set_termios,
1638 .stop = mcfrs_stop,
1639 .start = mcfrs_start,
1640 .hangup = mcfrs_hangup,
1641 .read_proc = mcfrs_readproc,
1642 .wait_until_sent = mcfrs_wait_until_sent,
1643 .tiocmget = mcfrs_tiocmget,
1644 .tiocmset = mcfrs_tiocmset,
1645 };
1646
1647 /* mcfrs_init inits the driver */
1648 static int __init
1649 mcfrs_init(void)
1650 {
1651 struct mcf_serial *info;
1652 unsigned long flags;
1653 int i;
1654
1655 /* Setup base handler, and timer table. */
1656 #ifdef MCFPP_DCD0
1657 init_timer(&mcfrs_timer_struct);
1658 mcfrs_timer_struct.function = mcfrs_timer;
1659 mcfrs_timer_struct.data = 0;
1660 mcfrs_timer_struct.expires = jiffies + HZ/25;
1661 add_timer(&mcfrs_timer_struct);
1662 mcfrs_ppstatus = mcf_getppdata() & (MCFPP_DCD0 | MCFPP_DCD1);
1663 #endif
1664 mcfrs_serial_driver = alloc_tty_driver(NR_PORTS);
1665 if (!mcfrs_serial_driver)
1666 return -ENOMEM;
1667
1668 show_serial_version();
1669
1670 /* Initialize the tty_driver structure */
1671 mcfrs_serial_driver->owner = THIS_MODULE;
1672 mcfrs_serial_driver->name = "ttyS";
1673 mcfrs_serial_driver->devfs_name = "ttys/";
1674 mcfrs_serial_driver->driver_name = "serial";
1675 mcfrs_serial_driver->major = TTY_MAJOR;
1676 mcfrs_serial_driver->minor_start = 64;
1677 mcfrs_serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
1678 mcfrs_serial_driver->subtype = SERIAL_TYPE_NORMAL;
1679 mcfrs_serial_driver->init_termios = tty_std_termios;
1680
1681 mcfrs_serial_driver->init_termios.c_cflag =
1682 mcfrs_console_cbaud | CS8 | CREAD | HUPCL | CLOCAL;
1683 mcfrs_serial_driver->flags = TTY_DRIVER_REAL_RAW;
1684
1685 tty_set_operations(mcfrs_serial_driver, &mcfrs_ops);
1686
1687 if (tty_register_driver(mcfrs_serial_driver)) {
1688 printk("MCFRS: Couldn't register serial driver\n");
1689 put_tty_driver(mcfrs_serial_driver);
1690 return(-EBUSY);
1691 }
1692
1693 local_irq_save(flags);
1694
1695 /*
1696 * Configure all the attached serial ports.
1697 */
1698 for (i = 0, info = mcfrs_table; (i < NR_PORTS); i++, info++) {
1699 info->magic = SERIAL_MAGIC;
1700 info->line = i;
1701 info->tty = 0;
1702 info->custom_divisor = 16;
1703 info->close_delay = 50;
1704 info->closing_wait = 3000;
1705 info->x_char = 0;
1706 info->event = 0;
1707 info->count = 0;
1708 info->blocked_open = 0;
1709 INIT_WORK(&info->tqueue, mcfrs_offintr, info);
1710 INIT_WORK(&info->tqueue_hangup, do_serial_hangup, info);
1711 init_waitqueue_head(&info->open_wait);
1712 init_waitqueue_head(&info->close_wait);
1713
1714 info->imr = 0;
1715 mcfrs_setsignals(info, 0, 0);
1716 mcfrs_irqinit(info);
1717
1718 printk("ttyS%d at 0x%04x (irq = %d)", info->line,
1719 (unsigned int) info->addr, info->irq);
1720 printk(" is a builtin ColdFire UART\n");
1721 }
1722
1723 local_irq_restore(flags);
1724 return 0;
1725 }
1726
1727 module_init(mcfrs_init);
1728
1729 /****************************************************************************/
1730 /* Serial Console */
1731 /****************************************************************************/
1732
1733 /*
1734 * Quick and dirty UART initialization, for console output.
1735 */
1736
1737 void mcfrs_init_console(void)
1738 {
1739 volatile unsigned char *uartp;
1740 unsigned int clk;
1741
1742 /*
1743 * Reset UART, get it into known state...
1744 */
1745 uartp = (volatile unsigned char *) (MCF_MBAR +
1746 (mcfrs_console_port ? MCFUART_BASE2 : MCFUART_BASE1));
1747
1748 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETRX; /* reset RX */
1749 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETTX; /* reset TX */
1750 uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETMRPTR; /* reset MR pointer */
1751
1752 /*
1753 * Set port for defined baud , 8 data bits, 1 stop bit, no parity.
1754 */
1755 uartp[MCFUART_UMR] = MCFUART_MR1_PARITYNONE | MCFUART_MR1_CS8;
1756 uartp[MCFUART_UMR] = MCFUART_MR2_STOP1;
1757
1758 clk = ((MCF_BUSCLK / mcfrs_console_baud) + 16) / 32; /* set baud */
1759 uartp[MCFUART_UBG1] = (clk & 0xff00) >> 8; /* set msb baud */
1760 uartp[MCFUART_UBG2] = (clk & 0xff); /* set lsb baud */
1761
1762 uartp[MCFUART_UCSR] = MCFUART_UCSR_RXCLKTIMER | MCFUART_UCSR_TXCLKTIMER;
1763 uartp[MCFUART_UCR] = MCFUART_UCR_RXENABLE | MCFUART_UCR_TXENABLE;
1764
1765 mcfrs_console_inited++;
1766 return;
1767 }
1768
1769
1770 /*
1771 * Setup for console. Argument comes from the boot command line.
1772 */
1773
1774 int mcfrs_console_setup(struct console *cp, char *arg)
1775 {
1776 int i, n = CONSOLE_BAUD_RATE;
1777
1778 if (!cp)
1779 return(-1);
1780
1781 if (!strncmp(cp->name, "ttyS", 4))
1782 mcfrs_console_port = cp->index;
1783 else if (!strncmp(cp->name, "cua", 3))
1784 mcfrs_console_port = cp->index;
1785 else
1786 return(-1);
1787
1788 if (arg)
1789 n = simple_strtoul(arg,NULL,0);
1790 for (i = 0; i < MCFRS_BAUD_TABLE_SIZE; i++)
1791 if (mcfrs_baud_table[i] == n)
1792 break;
1793 if (i < MCFRS_BAUD_TABLE_SIZE) {
1794 mcfrs_console_baud = n;
1795 mcfrs_console_cbaud = 0;
1796 if (i > 15) {
1797 mcfrs_console_cbaud |= CBAUDEX;
1798 i -= 15;
1799 }
1800 mcfrs_console_cbaud |= i;
1801 }
1802 mcfrs_init_console(); /* make sure baud rate changes */
1803 return(0);
1804 }
1805
1806
1807 static struct tty_driver *mcfrs_console_device(struct console *c, int *index)
1808 {
1809 *index = c->index;
1810 return mcfrs_serial_driver;
1811 }
1812
1813
1814 /*
1815 * Output a single character, using UART polled mode.
1816 * This is used for console output.
1817 */
1818
1819 void mcfrs_put_char(char ch)
1820 {
1821 volatile unsigned char *uartp;
1822 unsigned long flags;
1823 int i;
1824
1825 uartp = (volatile unsigned char *) (MCF_MBAR +
1826 (mcfrs_console_port ? MCFUART_BASE2 : MCFUART_BASE1));
1827
1828 local_irq_save(flags);
1829 for (i = 0; (i < 0x10000); i++) {
1830 if (uartp[MCFUART_USR] & MCFUART_USR_TXREADY)
1831 break;
1832 }
1833 if (i < 0x10000) {
1834 uartp[MCFUART_UTB] = ch;
1835 for (i = 0; (i < 0x10000); i++)
1836 if (uartp[MCFUART_USR] & MCFUART_USR_TXEMPTY)
1837 break;
1838 }
1839 if (i >= 0x10000)
1840 mcfrs_init_console(); /* try and get it back */
1841 local_irq_restore(flags);
1842
1843 return;
1844 }
1845
1846
1847 /*
1848 * rs_console_write is registered for printk output.
1849 */
1850
1851 void mcfrs_console_write(struct console *cp, const char *p, unsigned len)
1852 {
1853 if (!mcfrs_console_inited)
1854 mcfrs_init_console();
1855 while (len-- > 0) {
1856 if (*p == '\n')
1857 mcfrs_put_char('\r');
1858 mcfrs_put_char(*p++);
1859 }
1860 }
1861
1862 /*
1863 * declare our consoles
1864 */
1865
1866 struct console mcfrs_console = {
1867 .name = "ttyS",
1868 .write = mcfrs_console_write,
1869 .device = mcfrs_console_device,
1870 .setup = mcfrs_console_setup,
1871 .flags = CON_PRINTBUFFER,
1872 .index = -1,
1873 };
1874
1875 static int __init mcfrs_console_init(void)
1876 {
1877 register_console(&mcfrs_console);
1878 return 0;
1879 }
1880
1881 console_initcall(mcfrs_console_init);
1882
1883 /****************************************************************************/
Verdex Pro support