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) /* FIXME: 16MHz is likely wrong */
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
)
240 if((info
->port
.tty
->termios
->c_cflag
& CRTSCTS
) &&
241 ((info
->curregs
[3] & AUTO_ENAB
)==0)) {
242 info
->curregs
[3] |= AUTO_ENAB
;
243 info
->pendregs
[3] |= AUTO_ENAB
;
244 write_zsreg(info
->m68k_channel
, 3, info
->curregs
[3]);
247 if((info
->curregs
[3] & AUTO_ENAB
)) {
248 info
->curregs
[3] &= ~AUTO_ENAB
;
249 info
->pendregs
[3] &= ~AUTO_ENAB
;
250 write_zsreg(info
->m68k_channel
, 3, info
->curregs
[3]);
254 /* If this is console input and this is a
255 * 'break asserted' status change interrupt
256 * see if we can drop into the debugger
258 if((status
& URX_BREAK
) && info
->break_abort
)
259 batten_down_hatches();
263 static void receive_chars(struct m68k_serial
*info
, unsigned short rx
)
265 struct tty_struct
*tty
= info
->tty
;
266 m68328_uart
*uart
= &uart_addr
[info
->line
];
267 unsigned char ch
, flag
;
270 * This do { } while() loop will get ALL chars out of Rx FIFO
272 #ifndef CONFIG_XCOPILOT_BUGS
275 ch
= GET_FIELD(rx
, URX_RXDATA
);
278 if(URX_BREAK
& rx
) { /* whee, break received */
279 status_handle(info
, rx
);
281 #ifdef CONFIG_MAGIC_SYSRQ
282 } else if (ch
== 0x10) { /* ^P */
286 /* show_net_buffers(); */
288 } else if (ch
== 0x12) { /* ^R */
291 #endif /* CONFIG_MAGIC_SYSRQ */
300 if(rx
& URX_PARITY_ERROR
) {
302 status_handle(info
, rx
);
303 } else if(rx
& URX_OVRUN
) {
305 status_handle(info
, rx
);
306 } else if(rx
& URX_FRAME_ERROR
) {
308 status_handle(info
, rx
);
310 tty_insert_flip_char(tty
, ch
, flag
);
311 #ifndef CONFIG_XCOPILOT_BUGS
312 } while((rx
= uart
->urx
.w
) & URX_DATA_READY
);
315 tty_schedule_flip(tty
);
321 static void transmit_chars(struct m68k_serial
*info
)
323 m68328_uart
*uart
= &uart_addr
[info
->line
];
327 uart
->utx
.b
.txdata
= info
->x_char
;
329 goto clear_and_return
;
332 if((info
->xmit_cnt
<= 0) || info
->tty
->stopped
) {
333 /* That's peculiar... TX ints off */
334 uart
->ustcnt
&= ~USTCNT_TX_INTR_MASK
;
335 goto clear_and_return
;
339 uart
->utx
.b
.txdata
= info
->xmit_buf
[info
->xmit_tail
++];
340 info
->xmit_tail
= info
->xmit_tail
& (SERIAL_XMIT_SIZE
-1);
343 if (info
->xmit_cnt
< WAKEUP_CHARS
)
344 schedule_work(&info
->tqueue
);
346 if(info
->xmit_cnt
<= 0) {
347 /* All done for now... TX ints off */
348 uart
->ustcnt
&= ~USTCNT_TX_INTR_MASK
;
349 goto clear_and_return
;
353 /* Clear interrupt (should be auto)*/
358 * This is the serial driver's generic interrupt routine
360 irqreturn_t
rs_interrupt(int irq
, void *dev_id
)
362 struct m68k_serial
*info
= dev_id
;
367 uart
= &uart_addr
[info
->line
];
373 if (rx
& URX_DATA_READY
) receive_chars(info
, rx
);
374 if (tx
& UTX_TX_AVAIL
) transmit_chars(info
);
376 receive_chars(info
, rx
);
381 static void do_softint(struct work_struct
*work
)
383 struct m68k_serial
*info
= container_of(work
, struct m68k_serial
, tqueue
);
384 struct tty_struct
*tty
;
390 if (clear_bit(RS_EVENT_WRITE_WAKEUP
, &info
->event
)) {
396 static int startup(struct m68k_serial
* info
)
398 m68328_uart
*uart
= &uart_addr
[info
->line
];
401 if (info
->flags
& S_INITIALIZED
)
404 if (!info
->xmit_buf
) {
405 info
->xmit_buf
= (unsigned char *) __get_free_page(GFP_KERNEL
);
410 local_irq_save(flags
);
413 * Clear the FIFO buffers and disable them
414 * (they will be reenabled in change_speed())
417 uart
->ustcnt
= USTCNT_UEN
;
418 info
->xmit_fifo_size
= 1;
419 uart
->ustcnt
= USTCNT_UEN
| USTCNT_RXEN
| USTCNT_TXEN
;
423 * Finally, enable sequencing and interrupts
426 uart
->ustcnt
= USTCNT_UEN
| USTCNT_RXEN
|
427 USTCNT_RX_INTR_MASK
| USTCNT_TX_INTR_MASK
;
429 uart
->ustcnt
= USTCNT_UEN
| USTCNT_RXEN
| USTCNT_RX_INTR_MASK
;
433 clear_bit(TTY_IO_ERROR
, &info
->tty
->flags
);
434 info
->xmit_cnt
= info
->xmit_head
= info
->xmit_tail
= 0;
437 * and set the speed of the serial port
442 info
->flags
|= S_INITIALIZED
;
443 local_irq_restore(flags
);
448 * This routine will shutdown a serial port; interrupts are disabled, and
449 * DTR is dropped if the hangup on close termio flag is on.
451 static void shutdown(struct m68k_serial
* info
)
453 m68328_uart
*uart
= &uart_addr
[info
->line
];
456 uart
->ustcnt
= 0; /* All off! */
457 if (!(info
->flags
& S_INITIALIZED
))
460 local_irq_save(flags
);
462 if (info
->xmit_buf
) {
463 free_page((unsigned long) info
->xmit_buf
);
468 set_bit(TTY_IO_ERROR
, &info
->tty
->flags
);
470 info
->flags
&= ~S_INITIALIZED
;
471 local_irq_restore(flags
);
475 int divisor
, prescale
;
477 #ifndef CONFIG_M68VZ328
478 hw_baud_table
[18] = {
493 {1,0x26}, /* 19200 */
494 {0,0x26}, /* 38400 */
495 {1,0x38}, /* 57600 */
496 {0,0x38}, /* 115200 */
499 hw_baud_table
[18] = {
514 {2,0x26}, /* 19200 */
515 {1,0x26}, /* 38400 */
516 {0,0x26}, /* 57600 */
517 {1,0x38}, /* 115200 */
520 /* rate = 1036800 / ((65 - prescale) * (1<<divider)) */
523 * This routine is called to set the UART divisor registers to match
524 * the specified baud rate for a serial port.
526 static void change_speed(struct m68k_serial
*info
)
528 m68328_uart
*uart
= &uart_addr
[info
->line
];
530 unsigned short ustcnt
;
534 if (!info
->tty
|| !info
->tty
->termios
)
536 cflag
= info
->tty
->termios
->c_cflag
;
537 if (!(port
= info
->port
))
540 ustcnt
= uart
->ustcnt
;
541 uart
->ustcnt
= ustcnt
& ~USTCNT_TXEN
;
545 i
= (i
& ~CBAUDEX
) + B38400
;
548 info
->baud
= baud_table
[i
];
549 uart
->ubaud
= PUT_FIELD(UBAUD_DIVIDE
, hw_baud_table
[i
].divisor
) |
550 PUT_FIELD(UBAUD_PRESCALER
, hw_baud_table
[i
].prescale
);
552 ustcnt
&= ~(USTCNT_PARITYEN
| USTCNT_ODD_EVEN
| USTCNT_STOP
| USTCNT_8_7
);
554 if ((cflag
& CSIZE
) == CS8
)
555 ustcnt
|= USTCNT_8_7
;
558 ustcnt
|= USTCNT_STOP
;
561 ustcnt
|= USTCNT_PARITYEN
;
563 ustcnt
|= USTCNT_ODD_EVEN
;
565 #ifdef CONFIG_SERIAL_68328_RTS_CTS
566 if (cflag
& CRTSCTS
) {
567 uart
->utx
.w
&= ~ UTX_NOCTS
;
569 uart
->utx
.w
|= UTX_NOCTS
;
573 ustcnt
|= USTCNT_TXEN
;
575 uart
->ustcnt
= ustcnt
;
580 * Fair output driver allows a process to speak.
582 static void rs_fair_output(void)
584 int left
; /* Output no more than that */
586 struct m68k_serial
*info
= &m68k_soft
[0];
589 if (info
== 0) return;
590 if (info
->xmit_buf
== 0) return;
592 local_irq_save(flags
);
593 left
= info
->xmit_cnt
;
595 c
= info
->xmit_buf
[info
->xmit_tail
];
596 info
->xmit_tail
= (info
->xmit_tail
+1) & (SERIAL_XMIT_SIZE
-1);
598 local_irq_restore(flags
);
602 local_irq_save(flags
);
603 left
= min(info
->xmit_cnt
, left
-1);
606 /* Last character is being transmitted now (hopefully). */
609 local_irq_restore(flags
);
614 * m68k_console_print is registered for printk.
616 void console_print_68328(const char *p
)
620 while((c
=*(p
++)) != 0) {
626 /* Comment this if you want to have a strict interrupt-driven output */
632 static void rs_set_ldisc(struct tty_struct
*tty
)
634 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
636 if (serial_paranoia_check(info
, tty
->name
, "rs_set_ldisc"))
639 info
->is_cons
= (tty
->termios
->c_line
== N_TTY
);
641 printk("ttyS%d console mode %s\n", info
->line
, info
->is_cons
? "on" : "off");
644 static void rs_flush_chars(struct tty_struct
*tty
)
646 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
647 m68328_uart
*uart
= &uart_addr
[info
->line
];
650 if (serial_paranoia_check(info
, tty
->name
, "rs_flush_chars"))
656 /* Enable transmitter */
657 local_irq_save(flags
);
659 if (info
->xmit_cnt
<= 0 || tty
->stopped
|| tty
->hw_stopped
||
661 local_irq_restore(flags
);
666 uart
->ustcnt
|= USTCNT_TXEN
| USTCNT_TX_INTR_MASK
;
668 uart
->ustcnt
|= USTCNT_TXEN
;
672 if (uart
->utx
.w
& UTX_TX_AVAIL
) {
677 uart
->utx
.b
.txdata
= info
->xmit_buf
[info
->xmit_tail
++];
678 info
->xmit_tail
= info
->xmit_tail
& (SERIAL_XMIT_SIZE
-1);
683 while (!(uart
->utx
.w
& UTX_TX_AVAIL
)) udelay(5);
686 local_irq_restore(flags
);
689 extern void console_printn(const char * b
, int count
);
691 static int rs_write(struct tty_struct
* tty
,
692 const unsigned char *buf
, int count
)
695 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
696 m68328_uart
*uart
= &uart_addr
[info
->line
];
699 if (serial_paranoia_check(info
, tty
->name
, "rs_write"))
702 if (!tty
|| !info
->xmit_buf
)
705 local_save_flags(flags
);
708 c
= min_t(int, count
, min(SERIAL_XMIT_SIZE
- info
->xmit_cnt
- 1,
709 SERIAL_XMIT_SIZE
- info
->xmit_head
));
710 local_irq_restore(flags
);
715 memcpy(info
->xmit_buf
+ info
->xmit_head
, buf
, c
);
718 info
->xmit_head
= (info
->xmit_head
+ c
) & (SERIAL_XMIT_SIZE
-1);
720 local_irq_restore(flags
);
726 if (info
->xmit_cnt
&& !tty
->stopped
&& !tty
->hw_stopped
) {
727 /* Enable transmitter */
730 while(info
->xmit_cnt
) {
733 uart
->ustcnt
|= USTCNT_TXEN
;
735 uart
->ustcnt
|= USTCNT_TX_INTR_MASK
;
737 while (!(uart
->utx
.w
& UTX_TX_AVAIL
)) udelay(5);
739 if (uart
->utx
.w
& UTX_TX_AVAIL
) {
740 uart
->utx
.b
.txdata
= info
->xmit_buf
[info
->xmit_tail
++];
741 info
->xmit_tail
= info
->xmit_tail
& (SERIAL_XMIT_SIZE
-1);
748 local_irq_restore(flags
);
754 static int rs_write_room(struct tty_struct
*tty
)
756 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
759 if (serial_paranoia_check(info
, tty
->name
, "rs_write_room"))
761 ret
= SERIAL_XMIT_SIZE
- info
->xmit_cnt
- 1;
767 static int rs_chars_in_buffer(struct tty_struct
*tty
)
769 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
771 if (serial_paranoia_check(info
, tty
->name
, "rs_chars_in_buffer"))
773 return info
->xmit_cnt
;
776 static void rs_flush_buffer(struct tty_struct
*tty
)
778 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
781 if (serial_paranoia_check(info
, tty
->name
, "rs_flush_buffer"))
783 local_irq_save(flags
);
784 info
->xmit_cnt
= info
->xmit_head
= info
->xmit_tail
= 0;
785 local_irq_restore(flags
);
790 * ------------------------------------------------------------
793 * This routine is called by the upper-layer tty layer to signal that
794 * incoming characters should be throttled.
795 * ------------------------------------------------------------
797 static void rs_throttle(struct tty_struct
* tty
)
799 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
801 if (serial_paranoia_check(info
, tty
->name
, "rs_throttle"))
805 info
->x_char
= STOP_CHAR(tty
);
807 /* Turn off RTS line (do this atomic) */
810 static void rs_unthrottle(struct tty_struct
* tty
)
812 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
814 if (serial_paranoia_check(info
, tty
->name
, "rs_unthrottle"))
821 info
->x_char
= START_CHAR(tty
);
824 /* Assert RTS line (do this atomic) */
828 * ------------------------------------------------------------
829 * rs_ioctl() and friends
830 * ------------------------------------------------------------
833 static int get_serial_info(struct m68k_serial
* info
,
834 struct serial_struct
* retinfo
)
836 struct serial_struct tmp
;
840 memset(&tmp
, 0, sizeof(tmp
));
841 tmp
.type
= info
->type
;
842 tmp
.line
= info
->line
;
843 tmp
.port
= info
->port
;
845 tmp
.flags
= info
->flags
;
846 tmp
.baud_base
= info
->baud_base
;
847 tmp
.close_delay
= info
->close_delay
;
848 tmp
.closing_wait
= info
->closing_wait
;
849 tmp
.custom_divisor
= info
->custom_divisor
;
850 if (copy_to_user(retinfo
, &tmp
, sizeof(*retinfo
)))
856 static int set_serial_info(struct m68k_serial
* info
,
857 struct serial_struct
* new_info
)
859 struct serial_struct new_serial
;
860 struct m68k_serial old_info
;
865 if (copy_from_user(&new_serial
, new_info
, sizeof(new_serial
)))
869 if (!capable(CAP_SYS_ADMIN
)) {
870 if ((new_serial
.baud_base
!= info
->baud_base
) ||
871 (new_serial
.type
!= info
->type
) ||
872 (new_serial
.close_delay
!= info
->close_delay
) ||
873 ((new_serial
.flags
& ~S_USR_MASK
) !=
874 (info
->flags
& ~S_USR_MASK
)))
876 info
->flags
= ((info
->flags
& ~S_USR_MASK
) |
877 (new_serial
.flags
& S_USR_MASK
));
878 info
->custom_divisor
= new_serial
.custom_divisor
;
886 * OK, past this point, all the error checking has been done.
887 * At this point, we start making changes.....
890 info
->baud_base
= new_serial
.baud_base
;
891 info
->flags
= ((info
->flags
& ~S_FLAGS
) |
892 (new_serial
.flags
& S_FLAGS
));
893 info
->type
= new_serial
.type
;
894 info
->close_delay
= new_serial
.close_delay
;
895 info
->closing_wait
= new_serial
.closing_wait
;
898 retval
= startup(info
);
903 * get_lsr_info - get line status register info
905 * Purpose: Let user call ioctl() to get info when the UART physically
906 * is emptied. On bus types like RS485, the transmitter must
907 * release the bus after transmitting. This must be done when
908 * the transmit shift register is empty, not be done when the
909 * transmit holding register is empty. This functionality
910 * allows an RS485 driver to be written in user space.
912 static int get_lsr_info(struct m68k_serial
* info
, unsigned int *value
)
914 #ifdef CONFIG_SERIAL_68328_RTS_CTS
915 m68328_uart
*uart
= &uart_addr
[info
->line
];
917 unsigned char status
;
920 local_irq_save(flags
);
921 #ifdef CONFIG_SERIAL_68328_RTS_CTS
922 status
= (uart
->utx
.w
& UTX_CTS_STAT
) ? 1 : 0;
926 local_irq_restore(flags
);
927 return put_user(status
, value
);
931 * This routine sends a break character out the serial port.
933 static void send_break(struct m68k_serial
* info
, unsigned int duration
)
935 m68328_uart
*uart
= &uart_addr
[info
->line
];
939 local_irq_save(flags
);
941 uart
->utx
.w
|= UTX_SEND_BREAK
;
942 msleep_interruptible(duration
);
943 uart
->utx
.w
&= ~UTX_SEND_BREAK
;
945 local_irq_restore(flags
);
948 static int rs_ioctl(struct tty_struct
*tty
,
949 unsigned int cmd
, unsigned long arg
)
951 struct m68k_serial
* info
= (struct m68k_serial
*)tty
->driver_data
;
954 if (serial_paranoia_check(info
, tty
->name
, "rs_ioctl"))
957 if ((cmd
!= TIOCGSERIAL
) && (cmd
!= TIOCSSERIAL
) &&
958 (cmd
!= TIOCSERCONFIG
) && (cmd
!= TIOCSERGWILD
) &&
959 (cmd
!= TIOCSERSWILD
) && (cmd
!= TIOCSERGSTRUCT
)) {
960 if (tty
->flags
& (1 << TTY_IO_ERROR
))
965 case TCSBRK
: /* SVID version: non-zero arg --> no break */
966 retval
= tty_check_change(tty
);
969 tty_wait_until_sent(tty
, 0);
971 send_break(info
, 250); /* 1/4 second */
973 case TCSBRKP
: /* support for POSIX tcsendbreak() */
974 retval
= tty_check_change(tty
);
977 tty_wait_until_sent(tty
, 0);
978 send_break(info
, arg
? arg
*(100) : 250);
981 return get_serial_info(info
,
982 (struct serial_struct
*) arg
);
984 return set_serial_info(info
,
985 (struct serial_struct
*) arg
);
986 case TIOCSERGETLSR
: /* Get line status register */
987 return get_lsr_info(info
, (unsigned int *) arg
);
989 if (copy_to_user((struct m68k_serial
*) arg
,
990 info
, sizeof(struct m68k_serial
)))
999 static void rs_set_termios(struct tty_struct
*tty
, struct ktermios
*old_termios
)
1001 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
1005 if ((old_termios
->c_cflag
& CRTSCTS
) &&
1006 !(tty
->termios
->c_cflag
& CRTSCTS
)) {
1007 tty
->hw_stopped
= 0;
1014 * ------------------------------------------------------------
1017 * This routine is called when the serial port gets closed. First, we
1018 * wait for the last remaining data to be sent. Then, we unlink its
1019 * S structure from the interrupt chain if necessary, and we free
1020 * that IRQ if nothing is left in the chain.
1021 * ------------------------------------------------------------
1023 static void rs_close(struct tty_struct
*tty
, struct file
* filp
)
1025 struct m68k_serial
* info
= (struct m68k_serial
*)tty
->driver_data
;
1026 m68328_uart
*uart
= &uart_addr
[info
->line
];
1027 unsigned long flags
;
1029 if (!info
|| serial_paranoia_check(info
, tty
->name
, "rs_close"))
1032 local_irq_save(flags
);
1034 if (tty_hung_up_p(filp
)) {
1035 local_irq_restore(flags
);
1039 if ((tty
->count
== 1) && (info
->count
!= 1)) {
1041 * Uh, oh. tty->count is 1, which means that the tty
1042 * structure will be freed. Info->count should always
1043 * be one in these conditions. If it's greater than
1044 * one, we've got real problems, since it means the
1045 * serial port won't be shutdown.
1047 printk("rs_close: bad serial port count; tty->count is 1, "
1048 "info->count is %d\n", info
->count
);
1051 if (--info
->count
< 0) {
1052 printk("rs_close: bad serial port count for ttyS%d: %d\n",
1053 info
->line
, info
->count
);
1057 local_irq_restore(flags
);
1060 info
->flags
|= S_CLOSING
;
1062 * Now we wait for the transmit buffer to clear; and we notify
1063 * the line discipline to only process XON/XOFF characters.
1066 if (info
->closing_wait
!= S_CLOSING_WAIT_NONE
)
1067 tty_wait_until_sent(tty
, info
->closing_wait
);
1069 * At this point we stop accepting input. To do this, we
1070 * disable the receive line status interrupts, and tell the
1071 * interrupt driver to stop checking the data ready bit in the
1072 * line status register.
1075 uart
->ustcnt
&= ~USTCNT_RXEN
;
1076 uart
->ustcnt
&= ~(USTCNT_RXEN
| USTCNT_RX_INTR_MASK
);
1079 rs_flush_buffer(tty
);
1081 tty_ldisc_flush(tty
);
1085 #warning "This is not and has never been valid so fix it"
1087 if (tty
->ldisc
.num
!= ldiscs
[N_TTY
].num
) {
1088 if (tty
->ldisc
.close
)
1089 (tty
->ldisc
.close
)(tty
);
1090 tty
->ldisc
= ldiscs
[N_TTY
];
1091 tty
->termios
->c_line
= N_TTY
;
1092 if (tty
->ldisc
.open
)
1093 (tty
->ldisc
.open
)(tty
);
1096 if (info
->blocked_open
) {
1097 if (info
->close_delay
) {
1098 msleep_interruptible(jiffies_to_msecs(info
->close_delay
));
1100 wake_up_interruptible(&info
->open_wait
);
1102 info
->flags
&= ~(S_NORMAL_ACTIVE
|S_CLOSING
);
1103 wake_up_interruptible(&info
->close_wait
);
1104 local_irq_restore(flags
);
1108 * rs_hangup() --- called by tty_hangup() when a hangup is signaled.
1110 void rs_hangup(struct tty_struct
*tty
)
1112 struct m68k_serial
* info
= (struct m68k_serial
*)tty
->driver_data
;
1114 if (serial_paranoia_check(info
, tty
->name
, "rs_hangup"))
1117 rs_flush_buffer(tty
);
1121 info
->flags
&= ~S_NORMAL_ACTIVE
;
1123 wake_up_interruptible(&info
->open_wait
);
1127 * ------------------------------------------------------------
1128 * rs_open() and friends
1129 * ------------------------------------------------------------
1131 static int block_til_ready(struct tty_struct
*tty
, struct file
* filp
,
1132 struct m68k_serial
*info
)
1134 DECLARE_WAITQUEUE(wait
, current
);
1139 * If the device is in the middle of being closed, then block
1140 * until it's done, and then try again.
1142 if (info
->flags
& S_CLOSING
) {
1143 interruptible_sleep_on(&info
->close_wait
);
1144 #ifdef SERIAL_DO_RESTART
1145 if (info
->flags
& S_HUP_NOTIFY
)
1148 return -ERESTARTSYS
;
1155 * If non-blocking mode is set, or the port is not enabled,
1156 * then make the check up front and then exit.
1158 if ((filp
->f_flags
& O_NONBLOCK
) ||
1159 (tty
->flags
& (1 << TTY_IO_ERROR
))) {
1160 info
->flags
|= S_NORMAL_ACTIVE
;
1164 if (tty
->termios
->c_cflag
& CLOCAL
)
1168 * Block waiting for the carrier detect and the line to become
1169 * free (i.e., not in use by the callout). While we are in
1170 * this loop, info->count is dropped by one, so that
1171 * rs_close() knows when to free things. We restore it upon
1172 * exit, either normal or abnormal.
1175 add_wait_queue(&info
->open_wait
, &wait
);
1178 info
->blocked_open
++;
1180 local_irq_disable();
1181 m68k_rtsdtr(info
, 1);
1183 current
->state
= TASK_INTERRUPTIBLE
;
1184 if (tty_hung_up_p(filp
) ||
1185 !(info
->flags
& S_INITIALIZED
)) {
1186 #ifdef SERIAL_DO_RESTART
1187 if (info
->flags
& S_HUP_NOTIFY
)
1190 retval
= -ERESTARTSYS
;
1196 if (!(info
->flags
& S_CLOSING
) && do_clocal
)
1198 if (signal_pending(current
)) {
1199 retval
= -ERESTARTSYS
;
1206 current
->state
= TASK_RUNNING
;
1207 remove_wait_queue(&info
->open_wait
, &wait
);
1208 if (!tty_hung_up_p(filp
))
1210 info
->blocked_open
--;
1214 info
->flags
|= S_NORMAL_ACTIVE
;
1219 * This routine is called whenever a serial port is opened. It
1220 * enables interrupts for a serial port, linking in its S structure into
1221 * the IRQ chain. It also performs the serial-specific
1222 * initialization for the tty structure.
1224 int rs_open(struct tty_struct
*tty
, struct file
* filp
)
1226 struct m68k_serial
*info
;
1231 if (line
>= NR_PORTS
|| line
< 0) /* we have exactly one */
1234 info
= &m68k_soft
[line
];
1236 if (serial_paranoia_check(info
, tty
->name
, "rs_open"))
1240 tty
->driver_data
= info
;
1244 * Start up serial port
1246 retval
= startup(info
);
1250 return block_til_ready(tty
, filp
, info
);
1253 /* Finally, routines used to initialize the serial driver. */
1255 static void show_serial_version(void)
1257 printk("MC68328 serial driver version 1.00\n");
1260 static const struct tty_operations rs_ops
= {
1264 .flush_chars
= rs_flush_chars
,
1265 .write_room
= rs_write_room
,
1266 .chars_in_buffer
= rs_chars_in_buffer
,
1267 .flush_buffer
= rs_flush_buffer
,
1269 .throttle
= rs_throttle
,
1270 .unthrottle
= rs_unthrottle
,
1271 .set_termios
= rs_set_termios
,
1274 .hangup
= rs_hangup
,
1275 .set_ldisc
= rs_set_ldisc
,
1278 /* rs_init inits the driver */
1283 struct m68k_serial
*info
;
1285 serial_driver
= alloc_tty_driver(NR_PORTS
);
1289 show_serial_version();
1291 /* Initialize the tty_driver structure */
1292 /* SPARC: Not all of this is exactly right for us. */
1294 serial_driver
->name
= "ttyS";
1295 serial_driver
->major
= TTY_MAJOR
;
1296 serial_driver
->minor_start
= 64;
1297 serial_driver
->type
= TTY_DRIVER_TYPE_SERIAL
;
1298 serial_driver
->subtype
= SERIAL_TYPE_NORMAL
;
1299 serial_driver
->init_termios
= tty_std_termios
;
1300 serial_driver
->init_termios
.c_cflag
=
1301 m68328_console_cbaud
| CS8
| CREAD
| HUPCL
| CLOCAL
;
1302 serial_driver
->flags
= TTY_DRIVER_REAL_RAW
;
1303 tty_set_operations(serial_driver
, &rs_ops
);
1305 if (tty_register_driver(serial_driver
)) {
1306 put_tty_driver(serial_driver
);
1307 printk(KERN_ERR
"Couldn't register serial driver\n");
1311 local_irq_save(flags
);
1313 for(i
=0;i
<NR_PORTS
;i
++) {
1315 info
= &m68k_soft
[i
];
1316 info
->magic
= SERIAL_MAGIC
;
1317 info
->port
= (int) &uart_addr
[i
];
1319 info
->irq
= uart_irqs
[i
];
1320 info
->custom_divisor
= 16;
1321 info
->close_delay
= 50;
1322 info
->closing_wait
= 3000;
1326 info
->blocked_open
= 0;
1327 INIT_WORK(&info
->tqueue
, do_softint
);
1328 init_waitqueue_head(&info
->open_wait
);
1329 init_waitqueue_head(&info
->close_wait
);
1331 info
->is_cons
= 1; /* Means shortcuts work */
1333 printk("%s%d at 0x%08x (irq = %d)", serial_driver
->name
, info
->line
,
1334 info
->port
, info
->irq
);
1335 printk(" is a builtin MC68328 UART\n");
1337 #ifdef CONFIG_M68VZ328
1339 PJSEL
&= 0xCF; /* PSW enable second port output */
1342 if (request_irq(uart_irqs
[i
],
1345 "M68328_UART", info
))
1346 panic("Unable to attach 68328 serial interrupt\n");
1348 local_irq_restore(flags
);
1352 module_init(rs68328_init
);
1356 static void m68328_set_baud(void)
1358 unsigned short ustcnt
;
1362 USTCNT
= ustcnt
& ~USTCNT_TXEN
;
1365 for (i
= 0; i
< ARRAY_SIZE(baud_table
); i
++)
1366 if (baud_table
[i
] == m68328_console_baud
)
1368 if (i
>= ARRAY_SIZE(baud_table
)) {
1369 m68328_console_baud
= 9600;
1373 UBAUD
= PUT_FIELD(UBAUD_DIVIDE
, hw_baud_table
[i
].divisor
) |
1374 PUT_FIELD(UBAUD_PRESCALER
, hw_baud_table
[i
].prescale
);
1375 ustcnt
&= ~(USTCNT_PARITYEN
| USTCNT_ODD_EVEN
| USTCNT_STOP
| USTCNT_8_7
);
1376 ustcnt
|= USTCNT_8_7
;
1377 ustcnt
|= USTCNT_TXEN
;
1379 m68328_console_initted
= 1;
1384 int m68328_console_setup(struct console
*cp
, char *arg
)
1386 int i
, n
= CONSOLE_BAUD_RATE
;
1392 n
= simple_strtoul(arg
,NULL
,0);
1394 for (i
= 0; i
< ARRAY_SIZE(baud_table
); i
++)
1395 if (baud_table
[i
] == n
)
1397 if (i
< ARRAY_SIZE(baud_table
)) {
1398 m68328_console_baud
= n
;
1399 m68328_console_cbaud
= 0;
1401 m68328_console_cbaud
|= CBAUDEX
;
1404 m68328_console_cbaud
|= i
;
1407 m68328_set_baud(); /* make sure baud rate changes */
1412 static struct tty_driver
*m68328_console_device(struct console
*c
, int *index
)
1415 return serial_driver
;
1419 void m68328_console_write (struct console
*co
, const char *str
,
1422 if (!m68328_console_initted
)
1427 rs_put_char( *str
++ );
1432 static struct console m68328_driver
= {
1434 .write
= m68328_console_write
,
1435 .device
= m68328_console_device
,
1436 .setup
= m68328_console_setup
,
1437 .flags
= CON_PRINTBUFFER
,
1442 static int __init
m68328_console_init(void)
1444 register_console(&m68328_driver
);
1448 console_initcall(m68328_console_init
);
This page took 0.05963 seconds and 5 git commands to generate.