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