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
)) {
397 * This routine is called from the scheduler tqueue when the interrupt
398 * routine has signalled that a hangup has occurred. The path of
399 * hangup processing is:
401 * serial interrupt routine -> (scheduler tqueue) ->
402 * do_serial_hangup() -> tty->hangup() -> rs_hangup()
405 static void do_serial_hangup(struct work_struct
*work
)
407 struct m68k_serial
*info
= container_of(work
, struct m68k_serial
, tqueue_hangup
);
408 struct tty_struct
*tty
;
418 static int startup(struct m68k_serial
* info
)
420 m68328_uart
*uart
= &uart_addr
[info
->line
];
423 if (info
->flags
& S_INITIALIZED
)
426 if (!info
->xmit_buf
) {
427 info
->xmit_buf
= (unsigned char *) __get_free_page(GFP_KERNEL
);
432 local_irq_save(flags
);
435 * Clear the FIFO buffers and disable them
436 * (they will be reenabled in change_speed())
439 uart
->ustcnt
= USTCNT_UEN
;
440 info
->xmit_fifo_size
= 1;
441 uart
->ustcnt
= USTCNT_UEN
| USTCNT_RXEN
| USTCNT_TXEN
;
445 * Finally, enable sequencing and interrupts
448 uart
->ustcnt
= USTCNT_UEN
| USTCNT_RXEN
|
449 USTCNT_RX_INTR_MASK
| USTCNT_TX_INTR_MASK
;
451 uart
->ustcnt
= USTCNT_UEN
| USTCNT_RXEN
| USTCNT_RX_INTR_MASK
;
455 clear_bit(TTY_IO_ERROR
, &info
->tty
->flags
);
456 info
->xmit_cnt
= info
->xmit_head
= info
->xmit_tail
= 0;
459 * and set the speed of the serial port
464 info
->flags
|= S_INITIALIZED
;
465 local_irq_restore(flags
);
470 * This routine will shutdown a serial port; interrupts are disabled, and
471 * DTR is dropped if the hangup on close termio flag is on.
473 static void shutdown(struct m68k_serial
* info
)
475 m68328_uart
*uart
= &uart_addr
[info
->line
];
478 uart
->ustcnt
= 0; /* All off! */
479 if (!(info
->flags
& S_INITIALIZED
))
482 local_irq_save(flags
);
484 if (info
->xmit_buf
) {
485 free_page((unsigned long) info
->xmit_buf
);
490 set_bit(TTY_IO_ERROR
, &info
->tty
->flags
);
492 info
->flags
&= ~S_INITIALIZED
;
493 local_irq_restore(flags
);
497 int divisor
, prescale
;
499 #ifndef CONFIG_M68VZ328
500 hw_baud_table
[18] = {
515 {1,0x26}, /* 19200 */
516 {0,0x26}, /* 38400 */
517 {1,0x38}, /* 57600 */
518 {0,0x38}, /* 115200 */
521 hw_baud_table
[18] = {
536 {2,0x26}, /* 19200 */
537 {1,0x26}, /* 38400 */
538 {0,0x26}, /* 57600 */
539 {1,0x38}, /* 115200 */
542 /* rate = 1036800 / ((65 - prescale) * (1<<divider)) */
545 * This routine is called to set the UART divisor registers to match
546 * the specified baud rate for a serial port.
548 static void change_speed(struct m68k_serial
*info
)
550 m68328_uart
*uart
= &uart_addr
[info
->line
];
552 unsigned short ustcnt
;
556 if (!info
->tty
|| !info
->tty
->termios
)
558 cflag
= info
->tty
->termios
->c_cflag
;
559 if (!(port
= info
->port
))
562 ustcnt
= uart
->ustcnt
;
563 uart
->ustcnt
= ustcnt
& ~USTCNT_TXEN
;
567 i
= (i
& ~CBAUDEX
) + B38400
;
570 info
->baud
= baud_table
[i
];
571 uart
->ubaud
= PUT_FIELD(UBAUD_DIVIDE
, hw_baud_table
[i
].divisor
) |
572 PUT_FIELD(UBAUD_PRESCALER
, hw_baud_table
[i
].prescale
);
574 ustcnt
&= ~(USTCNT_PARITYEN
| USTCNT_ODD_EVEN
| USTCNT_STOP
| USTCNT_8_7
);
576 if ((cflag
& CSIZE
) == CS8
)
577 ustcnt
|= USTCNT_8_7
;
580 ustcnt
|= USTCNT_STOP
;
583 ustcnt
|= USTCNT_PARITYEN
;
585 ustcnt
|= USTCNT_ODD_EVEN
;
587 #ifdef CONFIG_SERIAL_68328_RTS_CTS
588 if (cflag
& CRTSCTS
) {
589 uart
->utx
.w
&= ~ UTX_NOCTS
;
591 uart
->utx
.w
|= UTX_NOCTS
;
595 ustcnt
|= USTCNT_TXEN
;
597 uart
->ustcnt
= ustcnt
;
602 * Fair output driver allows a process to speak.
604 static void rs_fair_output(void)
606 int left
; /* Output no more than that */
608 struct m68k_serial
*info
= &m68k_soft
[0];
611 if (info
== 0) return;
612 if (info
->xmit_buf
== 0) return;
614 local_irq_save(flags
);
615 left
= info
->xmit_cnt
;
617 c
= info
->xmit_buf
[info
->xmit_tail
];
618 info
->xmit_tail
= (info
->xmit_tail
+1) & (SERIAL_XMIT_SIZE
-1);
620 local_irq_restore(flags
);
624 local_irq_save(flags
);
625 left
= min(info
->xmit_cnt
, left
-1);
628 /* Last character is being transmitted now (hopefully). */
631 local_irq_restore(flags
);
636 * m68k_console_print is registered for printk.
638 void console_print_68328(const char *p
)
642 while((c
=*(p
++)) != 0) {
648 /* Comment this if you want to have a strict interrupt-driven output */
654 static void rs_set_ldisc(struct tty_struct
*tty
)
656 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
658 if (serial_paranoia_check(info
, tty
->name
, "rs_set_ldisc"))
661 info
->is_cons
= (tty
->termios
->c_line
== N_TTY
);
663 printk("ttyS%d console mode %s\n", info
->line
, info
->is_cons
? "on" : "off");
666 static void rs_flush_chars(struct tty_struct
*tty
)
668 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
669 m68328_uart
*uart
= &uart_addr
[info
->line
];
672 if (serial_paranoia_check(info
, tty
->name
, "rs_flush_chars"))
678 /* Enable transmitter */
679 local_irq_save(flags
);
681 if (info
->xmit_cnt
<= 0 || tty
->stopped
|| tty
->hw_stopped
||
683 local_irq_restore(flags
);
688 uart
->ustcnt
|= USTCNT_TXEN
| USTCNT_TX_INTR_MASK
;
690 uart
->ustcnt
|= USTCNT_TXEN
;
694 if (uart
->utx
.w
& UTX_TX_AVAIL
) {
699 uart
->utx
.b
.txdata
= info
->xmit_buf
[info
->xmit_tail
++];
700 info
->xmit_tail
= info
->xmit_tail
& (SERIAL_XMIT_SIZE
-1);
705 while (!(uart
->utx
.w
& UTX_TX_AVAIL
)) udelay(5);
708 local_irq_restore(flags
);
711 extern void console_printn(const char * b
, int count
);
713 static int rs_write(struct tty_struct
* tty
,
714 const unsigned char *buf
, int count
)
717 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
718 m68328_uart
*uart
= &uart_addr
[info
->line
];
721 if (serial_paranoia_check(info
, tty
->name
, "rs_write"))
724 if (!tty
|| !info
->xmit_buf
)
727 local_save_flags(flags
);
730 c
= min_t(int, count
, min(SERIAL_XMIT_SIZE
- info
->xmit_cnt
- 1,
731 SERIAL_XMIT_SIZE
- info
->xmit_head
));
732 local_irq_restore(flags
);
737 memcpy(info
->xmit_buf
+ info
->xmit_head
, buf
, c
);
740 info
->xmit_head
= (info
->xmit_head
+ c
) & (SERIAL_XMIT_SIZE
-1);
742 local_irq_restore(flags
);
748 if (info
->xmit_cnt
&& !tty
->stopped
&& !tty
->hw_stopped
) {
749 /* Enable transmitter */
752 while(info
->xmit_cnt
) {
755 uart
->ustcnt
|= USTCNT_TXEN
;
757 uart
->ustcnt
|= USTCNT_TX_INTR_MASK
;
759 while (!(uart
->utx
.w
& UTX_TX_AVAIL
)) udelay(5);
761 if (uart
->utx
.w
& UTX_TX_AVAIL
) {
762 uart
->utx
.b
.txdata
= info
->xmit_buf
[info
->xmit_tail
++];
763 info
->xmit_tail
= info
->xmit_tail
& (SERIAL_XMIT_SIZE
-1);
770 local_irq_restore(flags
);
776 static int rs_write_room(struct tty_struct
*tty
)
778 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
781 if (serial_paranoia_check(info
, tty
->name
, "rs_write_room"))
783 ret
= SERIAL_XMIT_SIZE
- info
->xmit_cnt
- 1;
789 static int rs_chars_in_buffer(struct tty_struct
*tty
)
791 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
793 if (serial_paranoia_check(info
, tty
->name
, "rs_chars_in_buffer"))
795 return info
->xmit_cnt
;
798 static void rs_flush_buffer(struct tty_struct
*tty
)
800 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
803 if (serial_paranoia_check(info
, tty
->name
, "rs_flush_buffer"))
805 local_irq_save(flags
);
806 info
->xmit_cnt
= info
->xmit_head
= info
->xmit_tail
= 0;
807 local_irq_restore(flags
);
812 * ------------------------------------------------------------
815 * This routine is called by the upper-layer tty layer to signal that
816 * incoming characters should be throttled.
817 * ------------------------------------------------------------
819 static void rs_throttle(struct tty_struct
* tty
)
821 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
823 if (serial_paranoia_check(info
, tty
->name
, "rs_throttle"))
827 info
->x_char
= STOP_CHAR(tty
);
829 /* Turn off RTS line (do this atomic) */
832 static void rs_unthrottle(struct tty_struct
* tty
)
834 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
836 if (serial_paranoia_check(info
, tty
->name
, "rs_unthrottle"))
843 info
->x_char
= START_CHAR(tty
);
846 /* Assert RTS line (do this atomic) */
850 * ------------------------------------------------------------
851 * rs_ioctl() and friends
852 * ------------------------------------------------------------
855 static int get_serial_info(struct m68k_serial
* info
,
856 struct serial_struct
* retinfo
)
858 struct serial_struct tmp
;
862 memset(&tmp
, 0, sizeof(tmp
));
863 tmp
.type
= info
->type
;
864 tmp
.line
= info
->line
;
865 tmp
.port
= info
->port
;
867 tmp
.flags
= info
->flags
;
868 tmp
.baud_base
= info
->baud_base
;
869 tmp
.close_delay
= info
->close_delay
;
870 tmp
.closing_wait
= info
->closing_wait
;
871 tmp
.custom_divisor
= info
->custom_divisor
;
872 if (copy_to_user(retinfo
, &tmp
, sizeof(*retinfo
)))
878 static int set_serial_info(struct m68k_serial
* info
,
879 struct serial_struct
* new_info
)
881 struct serial_struct new_serial
;
882 struct m68k_serial old_info
;
887 if (copy_from_user(&new_serial
, new_info
, sizeof(new_serial
)))
891 if (!capable(CAP_SYS_ADMIN
)) {
892 if ((new_serial
.baud_base
!= info
->baud_base
) ||
893 (new_serial
.type
!= info
->type
) ||
894 (new_serial
.close_delay
!= info
->close_delay
) ||
895 ((new_serial
.flags
& ~S_USR_MASK
) !=
896 (info
->flags
& ~S_USR_MASK
)))
898 info
->flags
= ((info
->flags
& ~S_USR_MASK
) |
899 (new_serial
.flags
& S_USR_MASK
));
900 info
->custom_divisor
= new_serial
.custom_divisor
;
908 * OK, past this point, all the error checking has been done.
909 * At this point, we start making changes.....
912 info
->baud_base
= new_serial
.baud_base
;
913 info
->flags
= ((info
->flags
& ~S_FLAGS
) |
914 (new_serial
.flags
& S_FLAGS
));
915 info
->type
= new_serial
.type
;
916 info
->close_delay
= new_serial
.close_delay
;
917 info
->closing_wait
= new_serial
.closing_wait
;
920 retval
= startup(info
);
925 * get_lsr_info - get line status register info
927 * Purpose: Let user call ioctl() to get info when the UART physically
928 * is emptied. On bus types like RS485, the transmitter must
929 * release the bus after transmitting. This must be done when
930 * the transmit shift register is empty, not be done when the
931 * transmit holding register is empty. This functionality
932 * allows an RS485 driver to be written in user space.
934 static int get_lsr_info(struct m68k_serial
* info
, unsigned int *value
)
936 #ifdef CONFIG_SERIAL_68328_RTS_CTS
937 m68328_uart
*uart
= &uart_addr
[info
->line
];
939 unsigned char status
;
942 local_irq_save(flags
);
943 #ifdef CONFIG_SERIAL_68328_RTS_CTS
944 status
= (uart
->utx
.w
& UTX_CTS_STAT
) ? 1 : 0;
948 local_irq_restore(flags
);
949 return put_user(status
, value
);
953 * This routine sends a break character out the serial port.
955 static void send_break(struct m68k_serial
* info
, unsigned int duration
)
957 m68328_uart
*uart
= &uart_addr
[info
->line
];
961 local_irq_save(flags
);
963 uart
->utx
.w
|= UTX_SEND_BREAK
;
964 msleep_interruptible(duration
);
965 uart
->utx
.w
&= ~UTX_SEND_BREAK
;
967 local_irq_restore(flags
);
970 static int rs_ioctl(struct tty_struct
*tty
, struct file
* file
,
971 unsigned int cmd
, unsigned long arg
)
973 struct m68k_serial
* info
= (struct m68k_serial
*)tty
->driver_data
;
976 if (serial_paranoia_check(info
, tty
->name
, "rs_ioctl"))
979 if ((cmd
!= TIOCGSERIAL
) && (cmd
!= TIOCSSERIAL
) &&
980 (cmd
!= TIOCSERCONFIG
) && (cmd
!= TIOCSERGWILD
) &&
981 (cmd
!= TIOCSERSWILD
) && (cmd
!= TIOCSERGSTRUCT
)) {
982 if (tty
->flags
& (1 << TTY_IO_ERROR
))
987 case TCSBRK
: /* SVID version: non-zero arg --> no break */
988 retval
= tty_check_change(tty
);
991 tty_wait_until_sent(tty
, 0);
993 send_break(info
, 250); /* 1/4 second */
995 case TCSBRKP
: /* support for POSIX tcsendbreak() */
996 retval
= tty_check_change(tty
);
999 tty_wait_until_sent(tty
, 0);
1000 send_break(info
, arg
? arg
*(100) : 250);
1003 return get_serial_info(info
,
1004 (struct serial_struct
*) arg
);
1006 return set_serial_info(info
,
1007 (struct serial_struct
*) arg
);
1008 case TIOCSERGETLSR
: /* Get line status register */
1009 return get_lsr_info(info
, (unsigned int *) arg
);
1010 case TIOCSERGSTRUCT
:
1011 if (copy_to_user((struct m68k_serial
*) arg
,
1012 info
, sizeof(struct m68k_serial
)))
1016 return -ENOIOCTLCMD
;
1021 static void rs_set_termios(struct tty_struct
*tty
, struct ktermios
*old_termios
)
1023 struct m68k_serial
*info
= (struct m68k_serial
*)tty
->driver_data
;
1027 if ((old_termios
->c_cflag
& CRTSCTS
) &&
1028 !(tty
->termios
->c_cflag
& CRTSCTS
)) {
1029 tty
->hw_stopped
= 0;
1036 * ------------------------------------------------------------
1039 * This routine is called when the serial port gets closed. First, we
1040 * wait for the last remaining data to be sent. Then, we unlink its
1041 * S structure from the interrupt chain if necessary, and we free
1042 * that IRQ if nothing is left in the chain.
1043 * ------------------------------------------------------------
1045 static void rs_close(struct tty_struct
*tty
, struct file
* filp
)
1047 struct m68k_serial
* info
= (struct m68k_serial
*)tty
->driver_data
;
1048 m68328_uart
*uart
= &uart_addr
[info
->line
];
1049 unsigned long flags
;
1051 if (!info
|| serial_paranoia_check(info
, tty
->name
, "rs_close"))
1054 local_irq_save(flags
);
1056 if (tty_hung_up_p(filp
)) {
1057 local_irq_restore(flags
);
1061 if ((tty
->count
== 1) && (info
->count
!= 1)) {
1063 * Uh, oh. tty->count is 1, which means that the tty
1064 * structure will be freed. Info->count should always
1065 * be one in these conditions. If it's greater than
1066 * one, we've got real problems, since it means the
1067 * serial port won't be shutdown.
1069 printk("rs_close: bad serial port count; tty->count is 1, "
1070 "info->count is %d\n", info
->count
);
1073 if (--info
->count
< 0) {
1074 printk("rs_close: bad serial port count for ttyS%d: %d\n",
1075 info
->line
, info
->count
);
1079 local_irq_restore(flags
);
1082 info
->flags
|= S_CLOSING
;
1084 * Now we wait for the transmit buffer to clear; and we notify
1085 * the line discipline to only process XON/XOFF characters.
1088 if (info
->closing_wait
!= S_CLOSING_WAIT_NONE
)
1089 tty_wait_until_sent(tty
, info
->closing_wait
);
1091 * At this point we stop accepting input. To do this, we
1092 * disable the receive line status interrupts, and tell the
1093 * interrupt driver to stop checking the data ready bit in the
1094 * line status register.
1097 uart
->ustcnt
&= ~USTCNT_RXEN
;
1098 uart
->ustcnt
&= ~(USTCNT_RXEN
| USTCNT_RX_INTR_MASK
);
1101 rs_flush_buffer(tty
);
1103 tty_ldisc_flush(tty
);
1107 #warning "This is not and has never been valid so fix it"
1109 if (tty
->ldisc
.num
!= ldiscs
[N_TTY
].num
) {
1110 if (tty
->ldisc
.close
)
1111 (tty
->ldisc
.close
)(tty
);
1112 tty
->ldisc
= ldiscs
[N_TTY
];
1113 tty
->termios
->c_line
= N_TTY
;
1114 if (tty
->ldisc
.open
)
1115 (tty
->ldisc
.open
)(tty
);
1118 if (info
->blocked_open
) {
1119 if (info
->close_delay
) {
1120 msleep_interruptible(jiffies_to_msecs(info
->close_delay
));
1122 wake_up_interruptible(&info
->open_wait
);
1124 info
->flags
&= ~(S_NORMAL_ACTIVE
|S_CLOSING
);
1125 wake_up_interruptible(&info
->close_wait
);
1126 local_irq_restore(flags
);
1130 * rs_hangup() --- called by tty_hangup() when a hangup is signaled.
1132 void rs_hangup(struct tty_struct
*tty
)
1134 struct m68k_serial
* info
= (struct m68k_serial
*)tty
->driver_data
;
1136 if (serial_paranoia_check(info
, tty
->name
, "rs_hangup"))
1139 rs_flush_buffer(tty
);
1143 info
->flags
&= ~S_NORMAL_ACTIVE
;
1145 wake_up_interruptible(&info
->open_wait
);
1149 * ------------------------------------------------------------
1150 * rs_open() and friends
1151 * ------------------------------------------------------------
1153 static int block_til_ready(struct tty_struct
*tty
, struct file
* filp
,
1154 struct m68k_serial
*info
)
1156 DECLARE_WAITQUEUE(wait
, current
);
1161 * If the device is in the middle of being closed, then block
1162 * until it's done, and then try again.
1164 if (info
->flags
& S_CLOSING
) {
1165 interruptible_sleep_on(&info
->close_wait
);
1166 #ifdef SERIAL_DO_RESTART
1167 if (info
->flags
& S_HUP_NOTIFY
)
1170 return -ERESTARTSYS
;
1177 * If non-blocking mode is set, or the port is not enabled,
1178 * then make the check up front and then exit.
1180 if ((filp
->f_flags
& O_NONBLOCK
) ||
1181 (tty
->flags
& (1 << TTY_IO_ERROR
))) {
1182 info
->flags
|= S_NORMAL_ACTIVE
;
1186 if (tty
->termios
->c_cflag
& CLOCAL
)
1190 * Block waiting for the carrier detect and the line to become
1191 * free (i.e., not in use by the callout). While we are in
1192 * this loop, info->count is dropped by one, so that
1193 * rs_close() knows when to free things. We restore it upon
1194 * exit, either normal or abnormal.
1197 add_wait_queue(&info
->open_wait
, &wait
);
1200 info
->blocked_open
++;
1202 local_irq_disable();
1203 m68k_rtsdtr(info
, 1);
1205 current
->state
= TASK_INTERRUPTIBLE
;
1206 if (tty_hung_up_p(filp
) ||
1207 !(info
->flags
& S_INITIALIZED
)) {
1208 #ifdef SERIAL_DO_RESTART
1209 if (info
->flags
& S_HUP_NOTIFY
)
1212 retval
= -ERESTARTSYS
;
1218 if (!(info
->flags
& S_CLOSING
) && do_clocal
)
1220 if (signal_pending(current
)) {
1221 retval
= -ERESTARTSYS
;
1228 current
->state
= TASK_RUNNING
;
1229 remove_wait_queue(&info
->open_wait
, &wait
);
1230 if (!tty_hung_up_p(filp
))
1232 info
->blocked_open
--;
1236 info
->flags
|= S_NORMAL_ACTIVE
;
1241 * This routine is called whenever a serial port is opened. It
1242 * enables interrupts for a serial port, linking in its S structure into
1243 * the IRQ chain. It also performs the serial-specific
1244 * initialization for the tty structure.
1246 int rs_open(struct tty_struct
*tty
, struct file
* filp
)
1248 struct m68k_serial
*info
;
1253 if (line
>= NR_PORTS
|| line
< 0) /* we have exactly one */
1256 info
= &m68k_soft
[line
];
1258 if (serial_paranoia_check(info
, tty
->name
, "rs_open"))
1262 tty
->driver_data
= info
;
1266 * Start up serial port
1268 retval
= startup(info
);
1272 return block_til_ready(tty
, filp
, info
);
1275 /* Finally, routines used to initialize the serial driver. */
1277 static void show_serial_version(void)
1279 printk("MC68328 serial driver version 1.00\n");
1282 static const struct tty_operations rs_ops
= {
1286 .flush_chars
= rs_flush_chars
,
1287 .write_room
= rs_write_room
,
1288 .chars_in_buffer
= rs_chars_in_buffer
,
1289 .flush_buffer
= rs_flush_buffer
,
1291 .throttle
= rs_throttle
,
1292 .unthrottle
= rs_unthrottle
,
1293 .set_termios
= rs_set_termios
,
1296 .hangup
= rs_hangup
,
1297 .set_ldisc
= rs_set_ldisc
,
1300 /* rs_init inits the driver */
1305 struct m68k_serial
*info
;
1307 serial_driver
= alloc_tty_driver(NR_PORTS
);
1311 show_serial_version();
1313 /* Initialize the tty_driver structure */
1314 /* SPARC: Not all of this is exactly right for us. */
1316 serial_driver
->name
= "ttyS";
1317 serial_driver
->major
= TTY_MAJOR
;
1318 serial_driver
->minor_start
= 64;
1319 serial_driver
->type
= TTY_DRIVER_TYPE_SERIAL
;
1320 serial_driver
->subtype
= SERIAL_TYPE_NORMAL
;
1321 serial_driver
->init_termios
= tty_std_termios
;
1322 serial_driver
->init_termios
.c_cflag
=
1323 m68328_console_cbaud
| CS8
| CREAD
| HUPCL
| CLOCAL
;
1324 serial_driver
->flags
= TTY_DRIVER_REAL_RAW
;
1325 tty_set_operations(serial_driver
, &rs_ops
);
1327 if (tty_register_driver(serial_driver
)) {
1328 put_tty_driver(serial_driver
);
1329 printk(KERN_ERR
"Couldn't register serial driver\n");
1333 local_irq_save(flags
);
1335 for(i
=0;i
<NR_PORTS
;i
++) {
1337 info
= &m68k_soft
[i
];
1338 info
->magic
= SERIAL_MAGIC
;
1339 info
->port
= (int) &uart_addr
[i
];
1341 info
->irq
= uart_irqs
[i
];
1342 info
->custom_divisor
= 16;
1343 info
->close_delay
= 50;
1344 info
->closing_wait
= 3000;
1348 info
->blocked_open
= 0;
1349 INIT_WORK(&info
->tqueue
, do_softint
);
1350 INIT_WORK(&info
->tqueue_hangup
, do_serial_hangup
);
1351 init_waitqueue_head(&info
->open_wait
);
1352 init_waitqueue_head(&info
->close_wait
);
1354 info
->is_cons
= 1; /* Means shortcuts work */
1356 printk("%s%d at 0x%08x (irq = %d)", serial_driver
->name
, info
->line
,
1357 info
->port
, info
->irq
);
1358 printk(" is a builtin MC68328 UART\n");
1360 #ifdef CONFIG_M68VZ328
1362 PJSEL
&= 0xCF; /* PSW enable second port output */
1365 if (request_irq(uart_irqs
[i
],
1368 "M68328_UART", info
))
1369 panic("Unable to attach 68328 serial interrupt\n");
1371 local_irq_restore(flags
);
1375 module_init(rs68328_init
);
1379 static void m68328_set_baud(void)
1381 unsigned short ustcnt
;
1385 USTCNT
= ustcnt
& ~USTCNT_TXEN
;
1388 for (i
= 0; i
< ARRAY_SIZE(baud_table
); i
++)
1389 if (baud_table
[i
] == m68328_console_baud
)
1391 if (i
>= ARRAY_SIZE(baud_table
)) {
1392 m68328_console_baud
= 9600;
1396 UBAUD
= PUT_FIELD(UBAUD_DIVIDE
, hw_baud_table
[i
].divisor
) |
1397 PUT_FIELD(UBAUD_PRESCALER
, hw_baud_table
[i
].prescale
);
1398 ustcnt
&= ~(USTCNT_PARITYEN
| USTCNT_ODD_EVEN
| USTCNT_STOP
| USTCNT_8_7
);
1399 ustcnt
|= USTCNT_8_7
;
1400 ustcnt
|= USTCNT_TXEN
;
1402 m68328_console_initted
= 1;
1407 int m68328_console_setup(struct console
*cp
, char *arg
)
1409 int i
, n
= CONSOLE_BAUD_RATE
;
1415 n
= simple_strtoul(arg
,NULL
,0);
1417 for (i
= 0; i
< ARRAY_SIZE(baud_table
); i
++)
1418 if (baud_table
[i
] == n
)
1420 if (i
< ARRAY_SIZE(baud_table
)) {
1421 m68328_console_baud
= n
;
1422 m68328_console_cbaud
= 0;
1424 m68328_console_cbaud
|= CBAUDEX
;
1427 m68328_console_cbaud
|= i
;
1430 m68328_set_baud(); /* make sure baud rate changes */
1435 static struct tty_driver
*m68328_console_device(struct console
*c
, int *index
)
1438 return serial_driver
;
1442 void m68328_console_write (struct console
*co
, const char *str
,
1445 if (!m68328_console_initted
)
1450 rs_put_char( *str
++ );
1455 static struct console m68328_driver
= {
1457 .write
= m68328_console_write
,
1458 .device
= m68328_console_device
,
1459 .setup
= m68328_console_setup
,
1460 .flags
= CON_PRINTBUFFER
,
1465 static int __init
m68328_console_init(void)
1467 register_console(&m68328_driver
);
1471 console_initcall(m68328_console_init
);
This page took 0.119904 seconds and 5 git commands to generate.