1 /* 68328serial.c: Serial port driver for 68328 microcontroller
3 * Copyright (C) 1995 David S. Miller <davem@caip.rutgers.edu>
4 * Copyright (C) 1998 Kenneth Albanowski <kjahds@kjahds.com>
5 * Copyright (C) 1998, 1999 D. Jeff Dionne <jeff@uclinux.org>
6 * Copyright (C) 1999 Vladimir Gurevich <vgurevic@cisco.com>
7 * Copyright (C) 2002-2003 David McCullough <davidm@snapgear.com>
8 * Copyright (C) 2002 Greg Ungerer <gerg@snapgear.com>
10 * VZ Support/Fixes Evan Stawnyczy <e@lineo.ca>
11 * Multiple UART support Daniel Potts <danielp@cse.unsw.edu.au>
12 * Power management support Daniel Potts <danielp@cse.unsw.edu.au>
13 * VZ Second Serial Port enable Phil Wilshire
14 * 2.4/2.5 port David McCullough
18 #include <linux/module.h>
19 #include <linux/errno.h>
20 #include <linux/signal.h>
21 #include <linux/sched.h>
22 #include <linux/timer.h>
23 #include <linux/interrupt.h>
24 #include <linux/tty.h>
25 #include <linux/tty_flip.h>
26 #include <linux/major.h>
27 #include <linux/string.h>
28 #include <linux/fcntl.h>
30 #include <linux/kernel.h>
31 #include <linux/console.h>
32 #include <linux/reboot.h>
33 #include <linux/keyboard.h>
34 #include <linux/init.h>
36 #include <linux/bitops.h>
37 #include <linux/delay.h>
38 #include <linux/gfp.h>
42 #include <asm/system.h>
43 #include <asm/delay.h>
44 #include <asm/uaccess.h>
47 /* note: perhaps we can murge these files, so that you can just
48 * define 1 of them, and they can sort that out for themselves
50 #if defined(CONFIG_M68EZ328)
51 #include <asm/MC68EZ328.h>
53 #if defined(CONFIG_M68VZ328)
54 #include <asm/MC68VZ328.h>
56 #include <asm/MC68328.h>
57 #endif /* CONFIG_M68VZ328 */
58 #endif /* CONFIG_M68EZ328 */
60 #include "68328serial.h"
62 /* Turn off usage of real serial interrupt code, to "support" Copilot */
63 #ifdef CONFIG_XCOPILOT_BUGS
69 static struct m68k_serial m68k_soft
[NR_PORTS
];
71 static unsigned int uart_irqs
[NR_PORTS
] = UART_IRQ_DEFNS
;
73 /* multiple ports are contiguous in memory */
74 m68328_uart
*uart_addr
= (m68328_uart
*)USTCNT_ADDR
;
76 struct tty_struct m68k_ttys
;
77 struct m68k_serial
*m68k_consinfo
= 0;
79 #define M68K_CLOCK (16667000)
81 struct tty_driver
*serial_driver
;
83 /* number of characters left in xmit buffer before we ask for more */
84 #define WAKEUP_CHARS 256
86 /* Debugging... DEBUG_INTR is bad to use when one of the zs
87 * lines is your console ;(
89 #undef SERIAL_DEBUG_INTR
90 #undef SERIAL_DEBUG_OPEN
91 #undef SERIAL_DEBUG_FLOW
93 #define RS_ISR_PASS_LIMIT 256
95 static void change_speed(struct m68k_serial
*info
);
98 * Setup for console. Argument comes from the boot command line.
101 /* note: this is messy, but it works, again, perhaps defined somewhere else?*/
102 #ifdef CONFIG_M68VZ328
103 #define CONSOLE_BAUD_RATE 19200
104 #define DEFAULT_CBAUD B19200
108 #ifndef CONSOLE_BAUD_RATE
109 #define CONSOLE_BAUD_RATE 9600
110 #define DEFAULT_CBAUD B9600
114 static int m68328_console_initted
= 0;
115 static int m68328_console_baud
= CONSOLE_BAUD_RATE
;
116 static int m68328_console_cbaud
= DEFAULT_CBAUD
;
119 static inline int serial_paranoia_check(struct m68k_serial
*info
,
120 char *name
, const char *routine
)
122 #ifdef SERIAL_PARANOIA_CHECK
123 static const char *badmagic
=
124 "Warning: bad magic number for serial struct %s in %s\n";
125 static const char *badinfo
=
126 "Warning: null m68k_serial for %s in %s\n";
129 printk(badinfo
, name
, routine
);
132 if (info
->magic
!= SERIAL_MAGIC
) {
133 printk(badmagic
, name
, routine
);
141 * This is used to figure out the divisor speeds and the timeouts
143 static int baud_table
[] = {
144 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
145 9600, 19200, 38400, 57600, 115200, 0 };
147 /* Sets or clears DTR/RTS on the requested line */
148 static inline void m68k_rtsdtr(struct m68k_serial
*ss
, int set
)
151 /* set the RTS/CTS line */
158 /* Utility routines */
159 static inline int get_baud(struct m68k_serial
*ss
)
161 unsigned long result
= 115200;
162 unsigned short int baud
= uart_addr
[ss
->line
].ubaud
;
163 if (GET_FIELD(baud
, UBAUD_PRESCALER
) == 0x38) result
= 38400;
164 result
>>= GET_FIELD(baud
, UBAUD_DIVIDE
);
170 * ------------------------------------------------------------
171 * rs_stop() and rs_start()
173 * This routines are called before setting or resetting tty->stopped.
174 * They enable or disable transmitter interrupts, as necessary.
175 * ------------------------------------------------------------
177 static void rs_stop(struct tty_struct
*tty
)
179 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
180 m68328_uart
*uart
= &uart_addr
[info
->line
];
183 if (serial_paranoia_check(info
, tty
->name
, "rs_stop"))
186 local_irq_save(flags
);
187 uart
->ustcnt
&= ~USTCNT_TXEN
;
188 local_irq_restore(flags
);
191 static int rs_put_char(char ch
)
193 int flags
, loops
= 0;
195 local_irq_save(flags
);
197 while (!(UTX
& UTX_TX_AVAIL
) && (loops
< 1000)) {
204 local_irq_restore(flags
);
208 static void rs_start(struct tty_struct
*tty
)
210 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
211 m68328_uart
*uart
= &uart_addr
[info
->line
];
214 if (serial_paranoia_check(info
, tty
->name
, "rs_start"))
217 local_irq_save(flags
);
218 if (info
->xmit_cnt
&& info
->xmit_buf
&& !(uart
->ustcnt
& USTCNT_TXEN
)) {
220 uart
->ustcnt
|= USTCNT_TXEN
| USTCNT_TX_INTR_MASK
;
222 uart
->ustcnt
|= USTCNT_TXEN
;
225 local_irq_restore(flags
);
228 /* Drop into either the boot monitor or kadb upon receiving a break
229 * from keyboard/console input.
231 static void batten_down_hatches(void)
233 /* Drop into the debugger */
236 static void status_handle(struct m68k_serial
*info
, unsigned short status
)
238 /* If this is console input and this is a
239 * 'break asserted' status change interrupt
240 * see if we can drop into the debugger
242 if((status
& URX_BREAK
) && info
->break_abort
)
243 batten_down_hatches();
247 static void receive_chars(struct m68k_serial
*info
, unsigned short rx
)
249 struct tty_struct
*tty
= info
->port
.tty
;
250 m68328_uart
*uart
= &uart_addr
[info
->line
];
251 unsigned char ch
, flag
;
254 * This do { } while() loop will get ALL chars out of Rx FIFO
256 #ifndef CONFIG_XCOPILOT_BUGS
259 ch
= GET_FIELD(rx
, URX_RXDATA
);
262 if(URX_BREAK
& rx
) { /* whee, break received */
263 status_handle(info
, rx
);
265 #ifdef CONFIG_MAGIC_SYSRQ
266 } else if (ch
== 0x10) { /* ^P */
270 /* show_net_buffers(); */
272 } else if (ch
== 0x12) { /* ^R */
275 #endif /* CONFIG_MAGIC_SYSRQ */
284 if(rx
& URX_PARITY_ERROR
) {
286 status_handle(info
, rx
);
287 } else if(rx
& URX_OVRUN
) {
289 status_handle(info
, rx
);
290 } else if(rx
& URX_FRAME_ERROR
) {
292 status_handle(info
, rx
);
294 tty_insert_flip_char(tty
, ch
, flag
);
295 #ifndef CONFIG_XCOPILOT_BUGS
296 } while((rx
= uart
->urx
.w
) & URX_DATA_READY
);
299 tty_schedule_flip(tty
);
305 static void transmit_chars(struct m68k_serial
*info
)
307 m68328_uart
*uart
= &uart_addr
[info
->line
];
311 uart
->utx
.b
.txdata
= info
->x_char
;
313 goto clear_and_return
;
316 if((info
->xmit_cnt
<= 0) || info
->port
.tty
->stopped
) {
317 /* That's peculiar... TX ints off */
318 uart
->ustcnt
&= ~USTCNT_TX_INTR_MASK
;
319 goto clear_and_return
;
323 uart
->utx
.b
.txdata
= info
->xmit_buf
[info
->xmit_tail
++];
324 info
->xmit_tail
= info
->xmit_tail
& (SERIAL_XMIT_SIZE
-1);
327 if (info
->xmit_cnt
< WAKEUP_CHARS
)
328 schedule_work(&info
->tqueue
);
330 if(info
->xmit_cnt
<= 0) {
331 /* All done for now... TX ints off */
332 uart
->ustcnt
&= ~USTCNT_TX_INTR_MASK
;
333 goto clear_and_return
;
337 /* Clear interrupt (should be auto)*/
342 * This is the serial driver's generic interrupt routine
344 irqreturn_t
rs_interrupt(int irq
, void *dev_id
)
346 struct m68k_serial
*info
= dev_id
;
351 uart
= &uart_addr
[info
->line
];
357 if (rx
& URX_DATA_READY
) receive_chars(info
, rx
);
358 if (tx
& UTX_TX_AVAIL
) transmit_chars(info
);
360 receive_chars(info
, rx
);
365 static void do_softint(struct work_struct
*work
)
367 struct m68k_serial
*info
= container_of(work
, struct m68k_serial
, tqueue
);
368 struct tty_struct
*tty
;
370 tty
= info
->port
.tty
;
376 * This routine is called from the scheduler tqueue when the interrupt
377 * routine has signalled that a hangup has occurred. The path of
378 * hangup processing is:
380 * serial interrupt routine -> (scheduler tqueue) ->
381 * do_serial_hangup() -> tty->hangup() -> rs_hangup()
384 static void do_serial_hangup(struct work_struct
*work
)
386 struct m68k_serial
*info
= container_of(work
, struct m68k_serial
, tqueue_hangup
);
387 struct tty_struct
*tty
;
389 tty
= info
->port
.tty
;
397 static int startup(struct m68k_serial
* info
)
399 m68328_uart
*uart
= &uart_addr
[info
->line
];
402 if (info
->flags
& S_INITIALIZED
)
405 if (!info
->xmit_buf
) {
406 info
->xmit_buf
= (unsigned char *) __get_free_page(GFP_KERNEL
);
411 local_irq_save(flags
);
414 * Clear the FIFO buffers and disable them
415 * (they will be reenabled in change_speed())
418 uart
->ustcnt
= USTCNT_UEN
;
419 info
->xmit_fifo_size
= 1;
420 uart
->ustcnt
= USTCNT_UEN
| USTCNT_RXEN
| USTCNT_TXEN
;
424 * Finally, enable sequencing and interrupts
427 uart
->ustcnt
= USTCNT_UEN
| USTCNT_RXEN
|
428 USTCNT_RX_INTR_MASK
| USTCNT_TX_INTR_MASK
;
430 uart
->ustcnt
= USTCNT_UEN
| USTCNT_RXEN
| USTCNT_RX_INTR_MASK
;
434 clear_bit(TTY_IO_ERROR
, &info
->port
.tty
->flags
);
435 info
->xmit_cnt
= info
->xmit_head
= info
->xmit_tail
= 0;
438 * and set the speed of the serial port
443 info
->flags
|= S_INITIALIZED
;
444 local_irq_restore(flags
);
449 * This routine will shutdown a serial port; interrupts are disabled, and
450 * DTR is dropped if the hangup on close termio flag is on.
452 static void shutdown(struct m68k_serial
* info
)
454 m68328_uart
*uart
= &uart_addr
[info
->line
];
457 uart
->ustcnt
= 0; /* All off! */
458 if (!(info
->flags
& S_INITIALIZED
))
461 local_irq_save(flags
);
463 if (info
->xmit_buf
) {
464 free_page((unsigned long) info
->xmit_buf
);
469 set_bit(TTY_IO_ERROR
, &info
->port
.tty
->flags
);
471 info
->flags
&= ~S_INITIALIZED
;
472 local_irq_restore(flags
);
476 int divisor
, prescale
;
478 #ifndef CONFIG_M68VZ328
479 hw_baud_table
[18] = {
494 {1,0x26}, /* 19200 */
495 {0,0x26}, /* 38400 */
496 {1,0x38}, /* 57600 */
497 {0,0x38}, /* 115200 */
500 hw_baud_table
[18] = {
515 {2,0x26}, /* 19200 */
516 {1,0x26}, /* 38400 */
517 {0,0x26}, /* 57600 */
518 {1,0x38}, /* 115200 */
521 /* rate = 1036800 / ((65 - prescale) * (1<<divider)) */
524 * This routine is called to set the UART divisor registers to match
525 * the specified baud rate for a serial port.
527 static void change_speed(struct m68k_serial
*info
)
529 m68328_uart
*uart
= &uart_addr
[info
->line
];
531 unsigned short ustcnt
;
535 if (!info
->port
.tty
|| !info
->port
.tty
->termios
)
537 cflag
= info
->port
.tty
->termios
->c_cflag
;
538 if (!(port
= info
->port
))
541 ustcnt
= uart
->ustcnt
;
542 uart
->ustcnt
= ustcnt
& ~USTCNT_TXEN
;
546 i
= (i
& ~CBAUDEX
) + B38400
;
549 info
->baud
= baud_table
[i
];
550 uart
->ubaud
= PUT_FIELD(UBAUD_DIVIDE
, hw_baud_table
[i
].divisor
) |
551 PUT_FIELD(UBAUD_PRESCALER
, hw_baud_table
[i
].prescale
);
553 ustcnt
&= ~(USTCNT_PARITYEN
| USTCNT_ODD_EVEN
| USTCNT_STOP
| USTCNT_8_7
);
555 if ((cflag
& CSIZE
) == CS8
)
556 ustcnt
|= USTCNT_8_7
;
559 ustcnt
|= USTCNT_STOP
;
562 ustcnt
|= USTCNT_PARITYEN
;
564 ustcnt
|= USTCNT_ODD_EVEN
;
566 #ifdef CONFIG_SERIAL_68328_RTS_CTS
567 if (cflag
& CRTSCTS
) {
568 uart
->utx
.w
&= ~ UTX_NOCTS
;
570 uart
->utx
.w
|= UTX_NOCTS
;
574 ustcnt
|= USTCNT_TXEN
;
576 uart
->ustcnt
= ustcnt
;
581 * Fair output driver allows a process to speak.
583 static void rs_fair_output(void)
585 int left
; /* Output no more than that */
587 struct m68k_serial
*info
= &m68k_soft
[0];
590 if (info
== 0) return;
591 if (info
->xmit_buf
== 0) return;
593 local_irq_save(flags
);
594 left
= info
->xmit_cnt
;
596 c
= info
->xmit_buf
[info
->xmit_tail
];
597 info
->xmit_tail
= (info
->xmit_tail
+1) & (SERIAL_XMIT_SIZE
-1);
599 local_irq_restore(flags
);
603 local_irq_save(flags
);
604 left
= min(info
->xmit_cnt
, left
-1);
607 /* Last character is being transmitted now (hopefully). */
610 local_irq_restore(flags
);
615 * m68k_console_print is registered for printk.
617 void console_print_68328(const char *p
)
621 while((c
=*(p
++)) != 0) {
627 /* Comment this if you want to have a strict interrupt-driven output */
633 static void rs_set_ldisc(struct tty_struct
*tty
)
635 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
637 if (serial_paranoia_check(info
, tty
->name
, "rs_set_ldisc"))
640 info
->is_cons
= (tty
->termios
->c_line
== N_TTY
);
642 printk("ttyS%d console mode %s\n", info
->line
, info
->is_cons
? "on" : "off");
645 static void rs_flush_chars(struct tty_struct
*tty
)
647 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
648 m68328_uart
*uart
= &uart_addr
[info
->line
];
651 if (serial_paranoia_check(info
, tty
->name
, "rs_flush_chars"))
657 /* Enable transmitter */
658 local_irq_save(flags
);
660 if (info
->xmit_cnt
<= 0 || tty
->stopped
|| tty
->hw_stopped
||
662 local_irq_restore(flags
);
667 uart
->ustcnt
|= USTCNT_TXEN
| USTCNT_TX_INTR_MASK
;
669 uart
->ustcnt
|= USTCNT_TXEN
;
673 if (uart
->utx
.w
& UTX_TX_AVAIL
) {
678 uart
->utx
.b
.txdata
= info
->xmit_buf
[info
->xmit_tail
++];
679 info
->xmit_tail
= info
->xmit_tail
& (SERIAL_XMIT_SIZE
-1);
684 while (!(uart
->utx
.w
& UTX_TX_AVAIL
)) udelay(5);
687 local_irq_restore(flags
);
690 extern void console_printn(const char * b
, int count
);
692 static int rs_write(struct tty_struct
* tty
,
693 const unsigned char *buf
, int count
)
696 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
697 m68328_uart
*uart
= &uart_addr
[info
->line
];
700 if (serial_paranoia_check(info
, tty
->name
, "rs_write"))
703 if (!tty
|| !info
->xmit_buf
)
706 local_save_flags(flags
);
709 c
= min_t(int, count
, min(SERIAL_XMIT_SIZE
- info
->xmit_cnt
- 1,
710 SERIAL_XMIT_SIZE
- info
->xmit_head
));
711 local_irq_restore(flags
);
716 memcpy(info
->xmit_buf
+ info
->xmit_head
, buf
, c
);
719 info
->xmit_head
= (info
->xmit_head
+ c
) & (SERIAL_XMIT_SIZE
-1);
721 local_irq_restore(flags
);
727 if (info
->xmit_cnt
&& !tty
->stopped
&& !tty
->hw_stopped
) {
728 /* Enable transmitter */
731 while(info
->xmit_cnt
) {
734 uart
->ustcnt
|= USTCNT_TXEN
;
736 uart
->ustcnt
|= USTCNT_TX_INTR_MASK
;
738 while (!(uart
->utx
.w
& UTX_TX_AVAIL
)) udelay(5);
740 if (uart
->utx
.w
& UTX_TX_AVAIL
) {
741 uart
->utx
.b
.txdata
= info
->xmit_buf
[info
->xmit_tail
++];
742 info
->xmit_tail
= info
->xmit_tail
& (SERIAL_XMIT_SIZE
-1);
749 local_irq_restore(flags
);
755 static int rs_write_room(struct tty_struct
*tty
)
757 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
760 if (serial_paranoia_check(info
, tty
->name
, "rs_write_room"))
762 ret
= SERIAL_XMIT_SIZE
- info
->xmit_cnt
- 1;
768 static int rs_chars_in_buffer(struct tty_struct
*tty
)
770 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
772 if (serial_paranoia_check(info
, tty
->name
, "rs_chars_in_buffer"))
774 return info
->xmit_cnt
;
777 static void rs_flush_buffer(struct tty_struct
*tty
)
779 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
782 if (serial_paranoia_check(info
, tty
->name
, "rs_flush_buffer"))
784 local_irq_save(flags
);
785 info
->xmit_cnt
= info
->xmit_head
= info
->xmit_tail
= 0;
786 local_irq_restore(flags
);
791 * ------------------------------------------------------------
794 * This routine is called by the upper-layer tty layer to signal that
795 * incoming characters should be throttled.
796 * ------------------------------------------------------------
798 static void rs_throttle(struct tty_struct
* tty
)
800 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
802 if (serial_paranoia_check(info
, tty
->name
, "rs_throttle"))
806 info
->x_char
= STOP_CHAR(tty
);
808 /* Turn off RTS line (do this atomic) */
811 static void rs_unthrottle(struct tty_struct
* tty
)
813 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
815 if (serial_paranoia_check(info
, tty
->name
, "rs_unthrottle"))
822 info
->x_char
= START_CHAR(tty
);
825 /* Assert RTS line (do this atomic) */
829 * ------------------------------------------------------------
830 * rs_ioctl() and friends
831 * ------------------------------------------------------------
834 static int get_serial_info(struct m68k_serial
* info
,
835 struct serial_struct
* retinfo
)
837 struct serial_struct tmp
;
841 memset(&tmp
, 0, sizeof(tmp
));
842 tmp
.type
= info
->type
;
843 tmp
.line
= info
->line
;
844 tmp
.port
= info
->port
;
846 tmp
.flags
= info
->flags
;
847 tmp
.baud_base
= info
->baud_base
;
848 tmp
.close_delay
= info
->close_delay
;
849 tmp
.closing_wait
= info
->closing_wait
;
850 tmp
.custom_divisor
= info
->custom_divisor
;
851 if (copy_to_user(retinfo
, &tmp
, sizeof(*retinfo
)))
857 static int set_serial_info(struct m68k_serial
* info
,
858 struct serial_struct
* new_info
)
860 struct serial_struct new_serial
;
861 struct m68k_serial old_info
;
866 if (copy_from_user(&new_serial
, new_info
, sizeof(new_serial
)))
870 if (!capable(CAP_SYS_ADMIN
)) {
871 if ((new_serial
.baud_base
!= info
->baud_base
) ||
872 (new_serial
.type
!= info
->type
) ||
873 (new_serial
.close_delay
!= info
->close_delay
) ||
874 ((new_serial
.flags
& ~S_USR_MASK
) !=
875 (info
->flags
& ~S_USR_MASK
)))
877 info
->flags
= ((info
->flags
& ~S_USR_MASK
) |
878 (new_serial
.flags
& S_USR_MASK
));
879 info
->custom_divisor
= new_serial
.custom_divisor
;
887 * OK, past this point, all the error checking has been done.
888 * At this point, we start making changes.....
891 info
->baud_base
= new_serial
.baud_base
;
892 info
->flags
= ((info
->flags
& ~S_FLAGS
) |
893 (new_serial
.flags
& S_FLAGS
));
894 info
->type
= new_serial
.type
;
895 info
->close_delay
= new_serial
.close_delay
;
896 info
->closing_wait
= new_serial
.closing_wait
;
899 retval
= startup(info
);
904 * get_lsr_info - get line status register info
906 * Purpose: Let user call ioctl() to get info when the UART physically
907 * is emptied. On bus types like RS485, the transmitter must
908 * release the bus after transmitting. This must be done when
909 * the transmit shift register is empty, not be done when the
910 * transmit holding register is empty. This functionality
911 * allows an RS485 driver to be written in user space.
913 static int get_lsr_info(struct m68k_serial
* info
, unsigned int *value
)
915 #ifdef CONFIG_SERIAL_68328_RTS_CTS
916 m68328_uart
*uart
= &uart_addr
[info
->line
];
918 unsigned char status
;
921 local_irq_save(flags
);
922 #ifdef CONFIG_SERIAL_68328_RTS_CTS
923 status
= (uart
->utx
.w
& UTX_CTS_STAT
) ? 1 : 0;
927 local_irq_restore(flags
);
928 return put_user(status
, value
);
932 * This routine sends a break character out the serial port.
934 static void send_break(struct m68k_serial
* info
, unsigned int duration
)
936 m68328_uart
*uart
= &uart_addr
[info
->line
];
940 local_irq_save(flags
);
942 uart
->utx
.w
|= UTX_SEND_BREAK
;
943 msleep_interruptible(duration
);
944 uart
->utx
.w
&= ~UTX_SEND_BREAK
;
946 local_irq_restore(flags
);
949 static int rs_ioctl(struct tty_struct
*tty
, struct file
* file
,
950 unsigned int cmd
, unsigned long arg
)
953 struct m68k_serial
* info
= (struct m68k_serial
*)tty
->driver_data
;
956 if (serial_paranoia_check(info
, tty
->name
, "rs_ioctl"))
959 if ((cmd
!= TIOCGSERIAL
) && (cmd
!= TIOCSSERIAL
) &&
960 (cmd
!= TIOCSERCONFIG
) && (cmd
!= TIOCSERGWILD
) &&
961 (cmd
!= TIOCSERSWILD
) && (cmd
!= TIOCSERGSTRUCT
)) {
962 if (tty
->flags
& (1 << TTY_IO_ERROR
))
967 case TCSBRK
: /* SVID version: non-zero arg --> no break */
968 retval
= tty_check_change(tty
);
971 tty_wait_until_sent(tty
, 0);
973 send_break(info
, 250); /* 1/4 second */
975 case TCSBRKP
: /* support for POSIX tcsendbreak() */
976 retval
= tty_check_change(tty
);
979 tty_wait_until_sent(tty
, 0);
980 send_break(info
, arg
? arg
*(100) : 250);
983 return get_serial_info(info
,
984 (struct serial_struct
*) arg
);
986 return set_serial_info(info
,
987 (struct serial_struct
*) arg
);
988 case TIOCSERGETLSR
: /* Get line status register */
989 return get_lsr_info(info
, (unsigned int *) arg
);
991 if (copy_to_user((struct m68k_serial
*) arg
,
992 info
, sizeof(struct m68k_serial
)))
1001 static void rs_set_termios(struct tty_struct
*tty
, struct ktermios
*old_termios
)
1003 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
1007 if ((old_termios
->c_cflag
& CRTSCTS
) &&
1008 !(tty
->termios
->c_cflag
& CRTSCTS
)) {
1009 tty
->hw_stopped
= 0;
1016 * ------------------------------------------------------------
1019 * This routine is called when the serial port gets closed. First, we
1020 * wait for the last remaining data to be sent. Then, we unlink its
1021 * S structure from the interrupt chain if necessary, and we free
1022 * that IRQ if nothing is left in the chain.
1023 * ------------------------------------------------------------
1025 static void rs_close(struct tty_struct
*tty
, struct file
* filp
)
1027 struct m68k_serial
* info
= (struct m68k_serial
*)tty
->driver_data
;
1028 m68328_uart
*uart
= &uart_addr
[info
->line
];
1029 unsigned long flags
;
1031 if (!info
|| serial_paranoia_check(info
, tty
->name
, "rs_close"))
1034 local_irq_save(flags
);
1036 if (tty_hung_up_p(filp
)) {
1037 local_irq_restore(flags
);
1041 if ((tty
->count
== 1) && (info
->count
!= 1)) {
1043 * Uh, oh. tty->count is 1, which means that the tty
1044 * structure will be freed. Info->count should always
1045 * be one in these conditions. If it's greater than
1046 * one, we've got real problems, since it means the
1047 * serial port won't be shutdown.
1049 printk("rs_close: bad serial port count; tty->count is 1, "
1050 "info->count is %d\n", info
->count
);
1053 if (--info
->count
< 0) {
1054 printk("rs_close: bad serial port count for ttyS%d: %d\n",
1055 info
->line
, info
->count
);
1059 local_irq_restore(flags
);
1062 info
->flags
|= S_CLOSING
;
1064 * Now we wait for the transmit buffer to clear; and we notify
1065 * the line discipline to only process XON/XOFF characters.
1068 if (info
->closing_wait
!= S_CLOSING_WAIT_NONE
)
1069 tty_wait_until_sent(tty
, info
->closing_wait
);
1071 * At this point we stop accepting input. To do this, we
1072 * disable the receive line status interrupts, and tell the
1073 * interrupt driver to stop checking the data ready bit in the
1074 * line status register.
1077 uart
->ustcnt
&= ~USTCNT_RXEN
;
1078 uart
->ustcnt
&= ~(USTCNT_RXEN
| USTCNT_RX_INTR_MASK
);
1081 rs_flush_buffer(tty
);
1083 tty_ldisc_flush(tty
);
1086 info
->port
.tty
= NULL
;
1087 #warning "This is not and has never been valid so fix it"
1088 if (info
->blocked_open
) {
1089 if (info
->close_delay
) {
1090 msleep_interruptible(jiffies_to_msecs(info
->close_delay
));
1092 wake_up_interruptible(&info
->open_wait
);
1094 info
->flags
&= ~(S_NORMAL_ACTIVE
|S_CLOSING
);
1095 wake_up_interruptible(&info
->close_wait
);
1096 local_irq_restore(flags
);
1100 * rs_hangup() --- called by tty_hangup() when a hangup is signaled.
1102 void rs_hangup(struct tty_struct
*tty
)
1104 struct m68k_serial
* info
= (struct m68k_serial
*)tty
->driver_data
;
1106 if (serial_paranoia_check(info
, tty
->name
, "rs_hangup"))
1109 rs_flush_buffer(tty
);
1113 info
->flags
&= ~S_NORMAL_ACTIVE
;
1114 info
->port
.tty
= NULL
;
1115 wake_up_interruptible(&info
->open_wait
);
1119 * ------------------------------------------------------------
1120 * rs_open() and friends
1121 * ------------------------------------------------------------
1123 static int block_til_ready(struct tty_struct
*tty
, struct file
* filp
,
1124 struct m68k_serial
*info
)
1126 DECLARE_WAITQUEUE(wait
, current
);
1131 * If the device is in the middle of being closed, then block
1132 * until it's done, and then try again.
1134 if (info
->flags
& S_CLOSING
) {
1135 interruptible_sleep_on(&info
->close_wait
);
1136 #ifdef SERIAL_DO_RESTART
1137 if (info
->flags
& S_HUP_NOTIFY
)
1140 return -ERESTARTSYS
;
1147 * If non-blocking mode is set, or the port is not enabled,
1148 * then make the check up front and then exit.
1150 if ((filp
->f_flags
& O_NONBLOCK
) ||
1151 (tty
->flags
& (1 << TTY_IO_ERROR
))) {
1152 info
->flags
|= S_NORMAL_ACTIVE
;
1156 if (tty
->termios
->c_cflag
& CLOCAL
)
1160 * Block waiting for the carrier detect and the line to become
1161 * free (i.e., not in use by the callout). While we are in
1162 * this loop, info->count is dropped by one, so that
1163 * rs_close() knows when to free things. We restore it upon
1164 * exit, either normal or abnormal.
1167 add_wait_queue(&info
->open_wait
, &wait
);
1170 info
->blocked_open
++;
1172 local_irq_disable();
1173 m68k_rtsdtr(info
, 1);
1175 current
->state
= TASK_INTERRUPTIBLE
;
1176 if (tty_hung_up_p(filp
) ||
1177 !(info
->flags
& S_INITIALIZED
)) {
1178 #ifdef SERIAL_DO_RESTART
1179 if (info
->flags
& S_HUP_NOTIFY
)
1182 retval
= -ERESTARTSYS
;
1188 if (!(info
->flags
& S_CLOSING
) && do_clocal
)
1190 if (signal_pending(current
)) {
1191 retval
= -ERESTARTSYS
;
1198 current
->state
= TASK_RUNNING
;
1199 remove_wait_queue(&info
->open_wait
, &wait
);
1200 if (!tty_hung_up_p(filp
))
1202 info
->blocked_open
--;
1206 info
->flags
|= S_NORMAL_ACTIVE
;
1211 * This routine is called whenever a serial port is opened. It
1212 * enables interrupts for a serial port, linking in its S structure into
1213 * the IRQ chain. It also performs the serial-specific
1214 * initialization for the tty structure.
1216 int rs_open(struct tty_struct
*tty
, struct file
* filp
)
1218 struct m68k_serial
*info
;
1223 if (line
>= NR_PORTS
|| line
< 0) /* we have exactly one */
1226 info
= &m68k_soft
[line
];
1228 if (serial_paranoia_check(info
, tty
->name
, "rs_open"))
1232 tty
->driver_data
= info
;
1233 info
->port
.tty
= tty
;
1236 * Start up serial port
1238 retval
= startup(info
);
1242 return block_til_ready(tty
, filp
, info
);
1245 /* Finally, routines used to initialize the serial driver. */
1247 static void show_serial_version(void)
1249 printk("MC68328 serial driver version 1.00\n");
1252 static const struct tty_operations rs_ops
= {
1256 .flush_chars
= rs_flush_chars
,
1257 .write_room
= rs_write_room
,
1258 .chars_in_buffer
= rs_chars_in_buffer
,
1259 .flush_buffer
= rs_flush_buffer
,
1261 .throttle
= rs_throttle
,
1262 .unthrottle
= rs_unthrottle
,
1263 .set_termios
= rs_set_termios
,
1266 .hangup
= rs_hangup
,
1267 .set_ldisc
= rs_set_ldisc
,
1270 /* rs_init inits the driver */
1275 struct m68k_serial
*info
;
1277 serial_driver
= alloc_tty_driver(NR_PORTS
);
1281 show_serial_version();
1283 /* Initialize the tty_driver structure */
1284 /* SPARC: Not all of this is exactly right for us. */
1286 serial_driver
->name
= "ttyS";
1287 serial_driver
->major
= TTY_MAJOR
;
1288 serial_driver
->minor_start
= 64;
1289 serial_driver
->type
= TTY_DRIVER_TYPE_SERIAL
;
1290 serial_driver
->subtype
= SERIAL_TYPE_NORMAL
;
1291 serial_driver
->init_termios
= tty_std_termios
;
1292 serial_driver
->init_termios
.c_cflag
=
1293 m68328_console_cbaud
| CS8
| CREAD
| HUPCL
| CLOCAL
;
1294 serial_driver
->flags
= TTY_DRIVER_REAL_RAW
;
1295 tty_set_operations(serial_driver
, &rs_ops
);
1297 if (tty_register_driver(serial_driver
)) {
1298 put_tty_driver(serial_driver
);
1299 printk(KERN_ERR
"Couldn't register serial driver\n");
1303 local_irq_save(flags
);
1305 for(i
=0;i
<NR_PORTS
;i
++) {
1307 info
= &m68k_soft
[i
];
1308 info
->magic
= SERIAL_MAGIC
;
1309 info
->port
= (int) &uart_addr
[i
];
1310 info
->port
.tty
= NULL
;
1311 info
->irq
= uart_irqs
[i
];
1312 info
->custom_divisor
= 16;
1313 info
->close_delay
= 50;
1314 info
->closing_wait
= 3000;
1318 info
->blocked_open
= 0;
1319 INIT_WORK(&info
->tqueue
, do_softint
);
1320 INIT_WORK(&info
->tqueue_hangup
, do_serial_hangup
);
1321 init_waitqueue_head(&info
->open_wait
);
1322 init_waitqueue_head(&info
->close_wait
);
1324 info
->is_cons
= 1; /* Means shortcuts work */
1326 printk("%s%d at 0x%08x (irq = %d)", serial_driver
->name
, info
->line
,
1327 info
->port
, info
->irq
);
1328 printk(" is a builtin MC68328 UART\n");
1330 #ifdef CONFIG_M68VZ328
1332 PJSEL
&= 0xCF; /* PSW enable second port output */
1335 if (request_irq(uart_irqs
[i
],
1338 "M68328_UART", info
))
1339 panic("Unable to attach 68328 serial interrupt\n");
1341 local_irq_restore(flags
);
1345 module_init(rs68328_init
);
1349 static void m68328_set_baud(void)
1351 unsigned short ustcnt
;
1355 USTCNT
= ustcnt
& ~USTCNT_TXEN
;
1358 for (i
= 0; i
< ARRAY_SIZE(baud_table
); i
++)
1359 if (baud_table
[i
] == m68328_console_baud
)
1361 if (i
>= ARRAY_SIZE(baud_table
)) {
1362 m68328_console_baud
= 9600;
1366 UBAUD
= PUT_FIELD(UBAUD_DIVIDE
, hw_baud_table
[i
].divisor
) |
1367 PUT_FIELD(UBAUD_PRESCALER
, hw_baud_table
[i
].prescale
);
1368 ustcnt
&= ~(USTCNT_PARITYEN
| USTCNT_ODD_EVEN
| USTCNT_STOP
| USTCNT_8_7
);
1369 ustcnt
|= USTCNT_8_7
;
1370 ustcnt
|= USTCNT_TXEN
;
1372 m68328_console_initted
= 1;
1377 int m68328_console_setup(struct console
*cp
, char *arg
)
1379 int i
, n
= CONSOLE_BAUD_RATE
;
1385 n
= simple_strtoul(arg
,NULL
,0);
1387 for (i
= 0; i
< ARRAY_SIZE(baud_table
); i
++)
1388 if (baud_table
[i
] == n
)
1390 if (i
< ARRAY_SIZE(baud_table
)) {
1391 m68328_console_baud
= n
;
1392 m68328_console_cbaud
= 0;
1394 m68328_console_cbaud
|= CBAUDEX
;
1397 m68328_console_cbaud
|= i
;
1400 m68328_set_baud(); /* make sure baud rate changes */
1405 static struct tty_driver
*m68328_console_device(struct console
*c
, int *index
)
1408 return serial_driver
;
1412 void m68328_console_write (struct console
*co
, const char *str
,
1415 if (!m68328_console_initted
)
1420 rs_put_char( *str
++ );
1425 static struct console m68328_driver
= {
1427 .write
= m68328_console_write
,
1428 .device
= m68328_console_device
,
1429 .setup
= m68328_console_setup
,
1430 .flags
= CON_PRINTBUFFER
,
1435 static int __init
m68328_console_init(void)
1437 register_console(&m68328_driver
);
1441 console_initcall(m68328_console_init
);