1 /* sunsab.c: ASYNC Driver for the SIEMENS SAB82532 DUSCC.
3 * Copyright (C) 1997 Eddie C. Dost (ecd@skynet.be)
4 * Copyright (C) 2002 David S. Miller (davem@redhat.com)
6 * Rewrote buffer handling to use CIRC(Circular Buffer) macros.
7 * Maxim Krasnyanskiy <maxk@qualcomm.com>
9 * Fixed to use tty_get_baud_rate, and to allow for arbitrary baud
10 * rates to be programmed into the UART. Also eliminated a lot of
11 * duplicated code in the console setup.
12 * Theodore Ts'o <tytso@mit.edu>, 2001-Oct-12
14 * Ported to new 2.5.x UART layer.
15 * David S. Miller <davem@redhat.com>
18 #include <linux/config.h>
19 #include <linux/module.h>
20 #include <linux/kernel.h>
21 #include <linux/sched.h>
22 #include <linux/errno.h>
23 #include <linux/tty.h>
24 #include <linux/tty_flip.h>
25 #include <linux/major.h>
26 #include <linux/string.h>
27 #include <linux/ptrace.h>
28 #include <linux/ioport.h>
29 #include <linux/circ_buf.h>
30 #include <linux/serial.h>
31 #include <linux/console.h>
32 #include <linux/spinlock.h>
33 #include <linux/slab.h>
34 #include <linux/init.h>
38 #include <asm/oplib.h>
41 #include <linux/serial_core.h>
46 struct uart_sunsab_port
{
47 struct uart_port port
; /* Generic UART port */
48 union sab82532_async_regs
*regs
; /* Chip registers */
49 unsigned long irqflags
; /* IRQ state flags */
50 int dsr
; /* Current DSR state */
51 unsigned int cec_timeout
; /* Chip poll timeout... */
52 unsigned int tec_timeout
; /* likewise */
53 unsigned char interrupt_mask0
;/* ISR0 masking */
54 unsigned char interrupt_mask1
;/* ISR1 masking */
55 unsigned char pvr_dtr_bit
; /* Which PVR bit is DTR */
56 unsigned char pvr_dsr_bit
; /* Which PVR bit is DSR */
57 int type
; /* SAB82532 version */
61 * This assumes you have a 29.4912 MHz clock for your UART.
63 #define SAB_BASE_BAUD ( 29491200 / 16 )
65 static char *sab82532_version
[16] = {
66 "V1.0", "V2.0", "V3.2", "V(0x03)",
67 "V(0x04)", "V(0x05)", "V(0x06)", "V(0x07)",
68 "V(0x08)", "V(0x09)", "V(0x0a)", "V(0x0b)",
69 "V(0x0c)", "V(0x0d)", "V(0x0e)", "V(0x0f)"
72 #define SAB82532_MAX_TEC_TIMEOUT 200000 /* 1 character time (at 50 baud) */
73 #define SAB82532_MAX_CEC_TIMEOUT 50000 /* 2.5 TX CLKs (at 50 baud) */
75 #define SAB82532_RECV_FIFO_SIZE 32 /* Standard async fifo sizes */
76 #define SAB82532_XMIT_FIFO_SIZE 32
78 static __inline__
void sunsab_tec_wait(struct uart_sunsab_port
*up
)
80 int timeout
= up
->tec_timeout
;
82 while ((readb(&up
->regs
->r
.star
) & SAB82532_STAR_TEC
) && --timeout
)
86 static __inline__
void sunsab_cec_wait(struct uart_sunsab_port
*up
)
88 int timeout
= up
->cec_timeout
;
90 while ((readb(&up
->regs
->r
.star
) & SAB82532_STAR_CEC
) && --timeout
)
94 static void receive_chars(struct uart_sunsab_port
*up
,
95 union sab82532_irq_status
*stat
,
98 struct tty_struct
*tty
= up
->port
.info
->tty
;
99 unsigned char buf
[32];
100 int saw_console_brk
= 0;
105 /* Read number of BYTES (Character + Status) available. */
106 if (stat
->sreg
.isr0
& SAB82532_ISR0_RPF
) {
107 count
= SAB82532_RECV_FIFO_SIZE
;
111 if (stat
->sreg
.isr0
& SAB82532_ISR0_TCD
) {
112 count
= readb(&up
->regs
->r
.rbcl
) & (SAB82532_RECV_FIFO_SIZE
- 1);
116 /* Issue a FIFO read command in case we where idle. */
117 if (stat
->sreg
.isr0
& SAB82532_ISR0_TIME
) {
119 writeb(SAB82532_CMDR_RFRD
, &up
->regs
->w
.cmdr
);
123 if (stat
->sreg
.isr0
& SAB82532_ISR0_RFO
)
127 for (i
= 0; i
< count
; i
++)
128 buf
[i
] = readb(&up
->regs
->r
.rfifo
[i
]);
130 /* Issue Receive Message Complete command. */
133 writeb(SAB82532_CMDR_RMC
, &up
->regs
->w
.cmdr
);
136 for (i
= 0; i
< count
; i
++) {
137 unsigned char ch
= buf
[i
];
139 if (unlikely(tty
->flip
.count
>= TTY_FLIPBUF_SIZE
)) {
140 tty
->flip
.work
.func((void *)tty
);
141 if (tty
->flip
.count
>= TTY_FLIPBUF_SIZE
)
142 return; // if TTY_DONT_FLIP is set
145 *tty
->flip
.char_buf_ptr
= ch
;
146 *tty
->flip
.flag_buf_ptr
= TTY_NORMAL
;
147 up
->port
.icount
.rx
++;
149 if (unlikely(stat
->sreg
.isr0
& (SAB82532_ISR0_PERR
|
151 SAB82532_ISR0_RFO
)) ||
152 unlikely(stat
->sreg
.isr1
& SAB82532_ISR1_BRK
)) {
154 * For statistics only
156 if (stat
->sreg
.isr1
& SAB82532_ISR1_BRK
) {
157 stat
->sreg
.isr0
&= ~(SAB82532_ISR0_PERR
|
159 up
->port
.icount
.brk
++;
160 if (up
->port
.line
== up
->port
.cons
->index
)
163 * We do the SysRQ and SAK checking
164 * here because otherwise the break
165 * may get masked by ignore_status_mask
166 * or read_status_mask.
168 if (uart_handle_break(&up
->port
))
170 } else if (stat
->sreg
.isr0
& SAB82532_ISR0_PERR
)
171 up
->port
.icount
.parity
++;
172 else if (stat
->sreg
.isr0
& SAB82532_ISR0_FERR
)
173 up
->port
.icount
.frame
++;
174 if (stat
->sreg
.isr0
& SAB82532_ISR0_RFO
)
175 up
->port
.icount
.overrun
++;
178 * Mask off conditions which should be ingored.
180 stat
->sreg
.isr0
&= (up
->port
.read_status_mask
& 0xff);
181 stat
->sreg
.isr1
&= ((up
->port
.read_status_mask
>> 8) & 0xff);
183 if (stat
->sreg
.isr1
& SAB82532_ISR1_BRK
) {
184 *tty
->flip
.flag_buf_ptr
= TTY_BREAK
;
185 } else if (stat
->sreg
.isr0
& SAB82532_ISR0_PERR
)
186 *tty
->flip
.flag_buf_ptr
= TTY_PARITY
;
187 else if (stat
->sreg
.isr0
& SAB82532_ISR0_FERR
)
188 *tty
->flip
.flag_buf_ptr
= TTY_FRAME
;
191 if (uart_handle_sysrq_char(&up
->port
, ch
, regs
))
194 if ((stat
->sreg
.isr0
& (up
->port
.ignore_status_mask
& 0xff)) == 0 &&
195 (stat
->sreg
.isr1
& ((up
->port
.ignore_status_mask
>> 8) & 0xff)) == 0){
196 tty
->flip
.flag_buf_ptr
++;
197 tty
->flip
.char_buf_ptr
++;
200 if ((stat
->sreg
.isr0
& SAB82532_ISR0_RFO
) &&
201 tty
->flip
.count
< TTY_FLIPBUF_SIZE
) {
203 * Overrun is special, since it's reported
204 * immediately, and doesn't affect the current
207 *tty
->flip
.flag_buf_ptr
= TTY_OVERRUN
;
208 tty
->flip
.flag_buf_ptr
++;
209 tty
->flip
.char_buf_ptr
++;
214 tty_flip_buffer_push(tty
);
220 static void sunsab_stop_tx(struct uart_port
*, unsigned int);
222 static void transmit_chars(struct uart_sunsab_port
*up
,
223 union sab82532_irq_status
*stat
)
225 struct circ_buf
*xmit
= &up
->port
.info
->xmit
;
228 if (stat
->sreg
.isr1
& SAB82532_ISR1_ALLS
) {
229 up
->interrupt_mask1
|= SAB82532_IMR1_ALLS
;
230 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
231 set_bit(SAB82532_ALLS
, &up
->irqflags
);
234 #if 0 /* bde@nwlink.com says this check causes problems */
235 if (!(stat
->sreg
.isr1
& SAB82532_ISR1_XPR
))
239 if (!(readb(&up
->regs
->r
.star
) & SAB82532_STAR_XFW
))
242 set_bit(SAB82532_XPR
, &up
->irqflags
);
244 if (uart_circ_empty(xmit
) || uart_tx_stopped(&up
->port
)) {
245 up
->interrupt_mask1
|= SAB82532_IMR1_XPR
;
246 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
247 uart_write_wakeup(&up
->port
);
251 up
->interrupt_mask1
&= ~(SAB82532_IMR1_ALLS
|SAB82532_IMR1_XPR
);
252 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
253 clear_bit(SAB82532_ALLS
, &up
->irqflags
);
255 /* Stuff 32 bytes into Transmit FIFO. */
256 clear_bit(SAB82532_XPR
, &up
->irqflags
);
257 for (i
= 0; i
< up
->port
.fifosize
; i
++) {
258 writeb(xmit
->buf
[xmit
->tail
],
259 &up
->regs
->w
.xfifo
[i
]);
260 xmit
->tail
= (xmit
->tail
+ 1) & (UART_XMIT_SIZE
- 1);
261 up
->port
.icount
.tx
++;
262 if (uart_circ_empty(xmit
))
266 /* Issue a Transmit Frame command. */
268 writeb(SAB82532_CMDR_XF
, &up
->regs
->w
.cmdr
);
270 if (uart_circ_chars_pending(xmit
) < WAKEUP_CHARS
)
271 uart_write_wakeup(&up
->port
);
273 if (uart_circ_empty(xmit
))
274 sunsab_stop_tx(&up
->port
, 0);
277 static void check_status(struct uart_sunsab_port
*up
,
278 union sab82532_irq_status
*stat
)
280 if (stat
->sreg
.isr0
& SAB82532_ISR0_CDSC
)
281 uart_handle_dcd_change(&up
->port
,
282 !(readb(&up
->regs
->r
.vstr
) & SAB82532_VSTR_CD
));
284 if (stat
->sreg
.isr1
& SAB82532_ISR1_CSC
)
285 uart_handle_cts_change(&up
->port
,
286 (readb(&up
->regs
->r
.star
) & SAB82532_STAR_CTS
));
288 if ((readb(&up
->regs
->r
.pvr
) & up
->pvr_dsr_bit
) ^ up
->dsr
) {
289 up
->dsr
= (readb(&up
->regs
->r
.pvr
) & up
->pvr_dsr_bit
) ? 0 : 1;
290 up
->port
.icount
.dsr
++;
293 wake_up_interruptible(&up
->port
.info
->delta_msr_wait
);
296 static irqreturn_t
sunsab_interrupt(int irq
, void *dev_id
, struct pt_regs
*regs
)
298 struct uart_sunsab_port
*up
= dev_id
;
299 union sab82532_irq_status status
;
302 spin_lock_irqsave(&up
->port
.lock
, flags
);
305 if (readb(&up
->regs
->r
.gis
) & SAB82532_GIS_ISA0
)
306 status
.sreg
.isr0
= readb(&up
->regs
->r
.isr0
);
307 if (readb(&up
->regs
->r
.gis
) & SAB82532_GIS_ISA1
)
308 status
.sreg
.isr1
= readb(&up
->regs
->r
.isr1
);
311 if (status
.sreg
.isr0
& (SAB82532_ISR0_TCD
| SAB82532_ISR0_TIME
|
312 SAB82532_ISR0_RFO
| SAB82532_ISR0_RPF
))
313 receive_chars(up
, &status
, regs
);
314 if ((status
.sreg
.isr0
& SAB82532_ISR0_CDSC
) ||
315 (status
.sreg
.isr1
& SAB82532_ISR1_CSC
))
316 check_status(up
, &status
);
317 if (status
.sreg
.isr1
& (SAB82532_ISR1_ALLS
| SAB82532_ISR1_XPR
))
318 transmit_chars(up
, &status
);
321 spin_unlock(&up
->port
.lock
);
325 spin_lock(&up
->port
.lock
);
328 if (readb(&up
->regs
->r
.gis
) & SAB82532_GIS_ISB0
)
329 status
.sreg
.isr0
= readb(&up
->regs
->r
.isr0
);
330 if (readb(&up
->regs
->r
.gis
) & SAB82532_GIS_ISB1
)
331 status
.sreg
.isr1
= readb(&up
->regs
->r
.isr1
);
334 if (status
.sreg
.isr0
& (SAB82532_ISR0_TCD
| SAB82532_ISR0_TIME
|
335 SAB82532_ISR0_RFO
| SAB82532_ISR0_RPF
))
336 receive_chars(up
, &status
, regs
);
337 if ((status
.sreg
.isr0
& SAB82532_ISR0_CDSC
) ||
338 (status
.sreg
.isr1
& (SAB82532_ISR1_BRK
| SAB82532_ISR1_CSC
)))
339 check_status(up
, &status
);
340 if (status
.sreg
.isr1
& (SAB82532_ISR1_ALLS
| SAB82532_ISR1_XPR
))
341 transmit_chars(up
, &status
);
344 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
349 /* port->lock is not held. */
350 static unsigned int sunsab_tx_empty(struct uart_port
*port
)
352 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
355 /* Do not need a lock for a state test like this. */
356 if (test_bit(SAB82532_ALLS
, &up
->irqflags
))
364 /* port->lock held by caller. */
365 static void sunsab_set_mctrl(struct uart_port
*port
, unsigned int mctrl
)
367 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
369 if (mctrl
& TIOCM_RTS
) {
370 writeb(readb(&up
->regs
->rw
.mode
) & ~SAB82532_MODE_FRTS
,
372 writeb(readb(&up
->regs
->rw
.mode
) | SAB82532_MODE_RTS
,
375 writeb(readb(&up
->regs
->rw
.mode
) | SAB82532_MODE_FRTS
,
377 writeb(readb(&up
->regs
->rw
.mode
) | SAB82532_MODE_RTS
,
380 if (mctrl
& TIOCM_DTR
) {
381 writeb(readb(&up
->regs
->rw
.pvr
) & ~(up
->pvr_dtr_bit
), &up
->regs
->rw
.pvr
);
383 writeb(readb(&up
->regs
->rw
.pvr
) | up
->pvr_dtr_bit
, &up
->regs
->rw
.pvr
);
387 /* port->lock is not held. */
388 static unsigned int sunsab_get_mctrl(struct uart_port
*port
)
390 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
397 spin_lock_irqsave(&up
->port
.lock
, flags
);
399 val
= readb(&up
->regs
->r
.pvr
);
400 result
|= (val
& up
->pvr_dsr_bit
) ? 0 : TIOCM_DSR
;
402 val
= readb(&up
->regs
->r
.vstr
);
403 result
|= (val
& SAB82532_VSTR_CD
) ? 0 : TIOCM_CAR
;
405 val
= readb(&up
->regs
->r
.star
);
406 result
|= (val
& SAB82532_STAR_CTS
) ? TIOCM_CTS
: 0;
408 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
413 /* port->lock held by caller. */
414 static void sunsab_stop_tx(struct uart_port
*port
, unsigned int tty_stop
)
416 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
418 up
->interrupt_mask1
|= SAB82532_IMR1_XPR
;
419 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
422 /* port->lock held by caller. */
423 static void sunsab_start_tx(struct uart_port
*port
, unsigned int tty_start
)
425 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
426 struct circ_buf
*xmit
= &up
->port
.info
->xmit
;
429 up
->interrupt_mask1
&= ~(SAB82532_IMR1_ALLS
|SAB82532_IMR1_XPR
);
430 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
432 if (!test_bit(SAB82532_XPR
, &up
->irqflags
))
435 clear_bit(SAB82532_ALLS
, &up
->irqflags
);
436 clear_bit(SAB82532_XPR
, &up
->irqflags
);
438 for (i
= 0; i
< up
->port
.fifosize
; i
++) {
439 writeb(xmit
->buf
[xmit
->tail
],
440 &up
->regs
->w
.xfifo
[i
]);
441 xmit
->tail
= (xmit
->tail
+ 1) & (UART_XMIT_SIZE
- 1);
442 up
->port
.icount
.tx
++;
443 if (uart_circ_empty(xmit
))
447 /* Issue a Transmit Frame command. */
449 writeb(SAB82532_CMDR_XF
, &up
->regs
->w
.cmdr
);
452 /* port->lock is not held. */
453 static void sunsab_send_xchar(struct uart_port
*port
, char ch
)
455 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
458 spin_lock_irqsave(&up
->port
.lock
, flags
);
461 writeb(ch
, &up
->regs
->w
.tic
);
463 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
466 /* port->lock held by caller. */
467 static void sunsab_stop_rx(struct uart_port
*port
)
469 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
471 up
->interrupt_mask0
|= SAB82532_ISR0_TCD
;
472 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr0
);
475 /* port->lock held by caller. */
476 static void sunsab_enable_ms(struct uart_port
*port
)
478 /* For now we always receive these interrupts. */
481 /* port->lock is not held. */
482 static void sunsab_break_ctl(struct uart_port
*port
, int break_state
)
484 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
488 spin_lock_irqsave(&up
->port
.lock
, flags
);
490 val
= readb(&up
->regs
->rw
.dafo
);
492 val
|= SAB82532_DAFO_XBRK
;
494 val
&= ~SAB82532_DAFO_XBRK
;
495 writeb(val
, &up
->regs
->rw
.dafo
);
497 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
500 /* port->lock is not held. */
501 static int sunsab_startup(struct uart_port
*port
)
503 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
507 spin_lock_irqsave(&up
->port
.lock
, flags
);
510 * Wait for any commands or immediate characters
516 * Clear the FIFO buffers.
518 writeb(SAB82532_CMDR_RRES
, &up
->regs
->w
.cmdr
);
520 writeb(SAB82532_CMDR_XRES
, &up
->regs
->w
.cmdr
);
523 * Clear the interrupt registers.
525 (void) readb(&up
->regs
->r
.isr0
);
526 (void) readb(&up
->regs
->r
.isr1
);
529 * Now, initialize the UART
531 writeb(0, &up
->regs
->w
.ccr0
); /* power-down */
532 writeb(SAB82532_CCR0_MCE
| SAB82532_CCR0_SC_NRZ
|
533 SAB82532_CCR0_SM_ASYNC
, &up
->regs
->w
.ccr0
);
534 writeb(SAB82532_CCR1_ODS
| SAB82532_CCR1_BCR
| 7, &up
->regs
->w
.ccr1
);
535 writeb(SAB82532_CCR2_BDF
| SAB82532_CCR2_SSEL
|
536 SAB82532_CCR2_TOE
, &up
->regs
->w
.ccr2
);
537 writeb(0, &up
->regs
->w
.ccr3
);
538 writeb(SAB82532_CCR4_MCK4
| SAB82532_CCR4_EBRG
, &up
->regs
->w
.ccr4
);
539 writeb(SAB82532_MODE_RTS
| SAB82532_MODE_FCTS
|
540 SAB82532_MODE_RAC
, &up
->regs
->w
.mode
);
541 writeb(SAB82532_RFC_DPS
|SAB82532_RFC_RFTH_32
, &up
->regs
->w
.rfc
);
543 tmp
= readb(&up
->regs
->rw
.ccr0
);
544 tmp
|= SAB82532_CCR0_PU
; /* power-up */
545 writeb(tmp
, &up
->regs
->rw
.ccr0
);
548 * Finally, enable interrupts
550 up
->interrupt_mask0
= (SAB82532_IMR0_PERR
| SAB82532_IMR0_FERR
|
552 writeb(up
->interrupt_mask0
, &up
->regs
->w
.imr0
);
553 up
->interrupt_mask1
= (SAB82532_IMR1_BRKT
| SAB82532_IMR1_ALLS
|
554 SAB82532_IMR1_XOFF
| SAB82532_IMR1_TIN
|
555 SAB82532_IMR1_CSC
| SAB82532_IMR1_XON
|
557 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
558 set_bit(SAB82532_ALLS
, &up
->irqflags
);
559 set_bit(SAB82532_XPR
, &up
->irqflags
);
561 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
566 /* port->lock is not held. */
567 static void sunsab_shutdown(struct uart_port
*port
)
569 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
573 spin_lock_irqsave(&up
->port
.lock
, flags
);
575 /* Disable Interrupts */
576 up
->interrupt_mask0
= 0xff;
577 writeb(up
->interrupt_mask0
, &up
->regs
->w
.imr0
);
578 up
->interrupt_mask1
= 0xff;
579 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
581 /* Disable break condition */
582 tmp
= readb(&up
->regs
->rw
.dafo
);
583 tmp
&= ~SAB82532_DAFO_XBRK
;
584 writeb(tmp
, &up
->regs
->rw
.dafo
);
586 /* Disable Receiver */
587 tmp
= readb(&up
->regs
->rw
.mode
);
588 tmp
&= ~SAB82532_MODE_RAC
;
589 writeb(tmp
, &up
->regs
->rw
.mode
);
594 * If the chip is powered down here the system hangs/crashes during
595 * reboot or shutdown. This needs to be investigated further,
596 * similar behaviour occurs in 2.4 when the driver is configured
597 * as a module only. One hint may be that data is sometimes
598 * transmitted at 9600 baud during shutdown (regardless of the
599 * speed the chip was configured for when the port was open).
603 tmp
= readb(&up
->regs
->rw
.ccr0
);
604 tmp
&= ~SAB82532_CCR0_PU
;
605 writeb(tmp
, &up
->regs
->rw
.ccr0
);
608 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
612 * This is used to figure out the divisor speeds.
614 * The formula is: Baud = SAB_BASE_BAUD / ((N + 1) * (1 << M)),
616 * with 0 <= N < 64 and 0 <= M < 16
619 static void calc_ebrg(int baud
, int *n_ret
, int *m_ret
)
630 * We scale numbers by 10 so that we get better accuracy
631 * without having to use floating point. Here we increment m
632 * until n is within the valid range.
634 n
= (SAB_BASE_BAUD
* 10) / baud
;
642 * We try very hard to avoid speeds with M == 0 since they may
643 * not work correctly for XTAL frequences above 10 MHz.
645 if ((m
== 0) && ((n
& 1) == 0)) {
653 /* Internal routine, port->lock is held and local interrupts are disabled. */
654 static void sunsab_convert_to_sab(struct uart_sunsab_port
*up
, unsigned int cflag
,
655 unsigned int iflag
, int baud
)
661 /* Byte size and parity */
662 switch (cflag
& CSIZE
) {
663 case CS5
: dafo
= SAB82532_DAFO_CHL5
; bits
= 7; break;
664 case CS6
: dafo
= SAB82532_DAFO_CHL6
; bits
= 8; break;
665 case CS7
: dafo
= SAB82532_DAFO_CHL7
; bits
= 9; break;
666 case CS8
: dafo
= SAB82532_DAFO_CHL8
; bits
= 10; break;
667 /* Never happens, but GCC is too dumb to figure it out */
668 default: dafo
= SAB82532_DAFO_CHL5
; bits
= 7; break;
671 if (cflag
& CSTOPB
) {
672 dafo
|= SAB82532_DAFO_STOP
;
676 if (cflag
& PARENB
) {
677 dafo
|= SAB82532_DAFO_PARE
;
681 if (cflag
& PARODD
) {
682 dafo
|= SAB82532_DAFO_PAR_ODD
;
684 dafo
|= SAB82532_DAFO_PAR_EVEN
;
687 calc_ebrg(baud
, &n
, &m
);
691 up
->tec_timeout
= (10 * 1000000) / baud
;
692 up
->cec_timeout
= up
->tec_timeout
>> 2;
694 /* CTS flow control flags */
695 /* We encode read_status_mask and ignore_status_mask like so:
697 * ---------------------
698 * | ... | ISR1 | ISR0 |
699 * ---------------------
703 up
->port
.read_status_mask
= (SAB82532_ISR0_TCD
| SAB82532_ISR0_TIME
|
704 SAB82532_ISR0_RFO
| SAB82532_ISR0_RPF
|
706 up
->port
.read_status_mask
|= (SAB82532_ISR1_CSC
|
708 SAB82532_ISR1_XPR
) << 8;
710 up
->port
.read_status_mask
|= (SAB82532_ISR0_PERR
|
712 if (iflag
& (BRKINT
| PARMRK
))
713 up
->port
.read_status_mask
|= (SAB82532_ISR1_BRK
<< 8);
716 * Characteres to ignore
718 up
->port
.ignore_status_mask
= 0;
720 up
->port
.ignore_status_mask
|= (SAB82532_ISR0_PERR
|
722 if (iflag
& IGNBRK
) {
723 up
->port
.ignore_status_mask
|= (SAB82532_ISR1_BRK
<< 8);
725 * If we're ignoring parity and break indicators,
726 * ignore overruns too (for real raw support).
729 up
->port
.ignore_status_mask
|= SAB82532_ISR0_RFO
;
733 * ignore all characters if CREAD is not set
735 if ((cflag
& CREAD
) == 0)
736 up
->port
.ignore_status_mask
|= (SAB82532_ISR0_RPF
|
739 /* Now bang the new settings into the chip. */
742 writeb(dafo
, &up
->regs
->w
.dafo
);
743 writeb(ebrg
& 0xff, &up
->regs
->w
.bgr
);
744 writeb((readb(&up
->regs
->rw
.ccr2
) & ~0xc0) | ((ebrg
>> 2) & 0xc0),
747 if (cflag
& CRTSCTS
) {
748 writeb(readb(&up
->regs
->rw
.mode
) & ~SAB82532_MODE_RTS
,
750 writeb(readb(&up
->regs
->rw
.mode
) | SAB82532_MODE_FRTS
,
752 writeb(readb(&up
->regs
->rw
.mode
) & ~SAB82532_MODE_FCTS
,
754 up
->interrupt_mask1
&= ~SAB82532_IMR1_CSC
;
755 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
757 writeb(readb(&up
->regs
->rw
.mode
) | SAB82532_MODE_RTS
,
759 writeb(readb(&up
->regs
->rw
.mode
) & ~SAB82532_MODE_FRTS
,
761 writeb(readb(&up
->regs
->rw
.mode
) | SAB82532_MODE_FCTS
,
763 up
->interrupt_mask1
|= SAB82532_IMR1_CSC
;
764 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
766 writeb(readb(&up
->regs
->rw
.mode
) | SAB82532_MODE_RAC
, &up
->regs
->rw
.mode
);
770 /* port->lock is not held. */
771 static void sunsab_set_termios(struct uart_port
*port
, struct termios
*termios
,
774 struct uart_sunsab_port
*up
= (struct uart_sunsab_port
*) port
;
776 int baud
= uart_get_baud_rate(port
, termios
, old
, 0, 4000000);
778 spin_lock_irqsave(&up
->port
.lock
, flags
);
779 sunsab_convert_to_sab(up
, termios
->c_cflag
, termios
->c_iflag
, baud
);
780 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
783 static const char *sunsab_type(struct uart_port
*port
)
785 struct uart_sunsab_port
*up
= (void *)port
;
788 sprintf(buf
, "SAB82532 %s", sab82532_version
[up
->type
]);
792 static void sunsab_release_port(struct uart_port
*port
)
796 static int sunsab_request_port(struct uart_port
*port
)
801 static void sunsab_config_port(struct uart_port
*port
, int flags
)
805 static int sunsab_verify_port(struct uart_port
*port
, struct serial_struct
*ser
)
810 static struct uart_ops sunsab_pops
= {
811 .tx_empty
= sunsab_tx_empty
,
812 .set_mctrl
= sunsab_set_mctrl
,
813 .get_mctrl
= sunsab_get_mctrl
,
814 .stop_tx
= sunsab_stop_tx
,
815 .start_tx
= sunsab_start_tx
,
816 .send_xchar
= sunsab_send_xchar
,
817 .stop_rx
= sunsab_stop_rx
,
818 .enable_ms
= sunsab_enable_ms
,
819 .break_ctl
= sunsab_break_ctl
,
820 .startup
= sunsab_startup
,
821 .shutdown
= sunsab_shutdown
,
822 .set_termios
= sunsab_set_termios
,
824 .release_port
= sunsab_release_port
,
825 .request_port
= sunsab_request_port
,
826 .config_port
= sunsab_config_port
,
827 .verify_port
= sunsab_verify_port
,
830 static struct uart_driver sunsab_reg
= {
831 .owner
= THIS_MODULE
,
832 .driver_name
= "serial",
833 .devfs_name
= "tts/",
838 static struct uart_sunsab_port
*sunsab_ports
;
839 static int num_channels
;
841 static __inline__
void sunsab_console_putchar(struct uart_sunsab_port
*up
, char c
)
845 spin_lock_irqsave(&up
->port
.lock
, flags
);
848 writeb(c
, &up
->regs
->w
.tic
);
850 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
853 static void sunsab_console_write(struct console
*con
, const char *s
, unsigned n
)
855 struct uart_sunsab_port
*up
= &sunsab_ports
[con
->index
];
858 for (i
= 0; i
< n
; i
++) {
860 sunsab_console_putchar(up
, '\r');
861 sunsab_console_putchar(up
, *s
++);
866 static int sunsab_console_setup(struct console
*con
, char *options
)
868 struct uart_sunsab_port
*up
= &sunsab_ports
[con
->index
];
872 printk("Console: ttyS%d (SAB82532)\n",
873 (sunsab_reg
.minor
- 64) + con
->index
);
875 sunserial_console_termios(con
);
877 /* Firmware console speed is limited to 150-->38400 baud so
878 * this hackish cflag thing is OK.
880 switch (con
->cflag
& CBAUD
) {
881 case B150
: baud
= 150; break;
882 case B300
: baud
= 300; break;
883 case B600
: baud
= 600; break;
884 case B1200
: baud
= 1200; break;
885 case B2400
: baud
= 2400; break;
886 case B4800
: baud
= 4800; break;
887 default: case B9600
: baud
= 9600; break;
888 case B19200
: baud
= 19200; break;
889 case B38400
: baud
= 38400; break;
895 spin_lock_init(&up
->port
.lock
);
898 * Initialize the hardware
900 sunsab_startup(&up
->port
);
902 spin_lock_irqsave(&up
->port
.lock
, flags
);
905 * Finally, enable interrupts
907 up
->interrupt_mask0
= SAB82532_IMR0_PERR
| SAB82532_IMR0_FERR
|
908 SAB82532_IMR0_PLLA
| SAB82532_IMR0_CDSC
;
909 writeb(up
->interrupt_mask0
, &up
->regs
->w
.imr0
);
910 up
->interrupt_mask1
= SAB82532_IMR1_BRKT
| SAB82532_IMR1_ALLS
|
911 SAB82532_IMR1_XOFF
| SAB82532_IMR1_TIN
|
912 SAB82532_IMR1_CSC
| SAB82532_IMR1_XON
|
914 writeb(up
->interrupt_mask1
, &up
->regs
->w
.imr1
);
916 sunsab_convert_to_sab(up
, con
->cflag
, 0, baud
);
918 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
923 static struct console sunsab_console
= {
925 .write
= sunsab_console_write
,
926 .device
= uart_console_device
,
927 .setup
= sunsab_console_setup
,
928 .flags
= CON_PRINTBUFFER
,
933 static void __init
sunsab_console_init(void)
937 if (con_is_present())
940 for (i
= 0; i
< num_channels
; i
++) {
941 int this_minor
= sunsab_reg
.minor
+ i
;
943 if ((this_minor
- 64) == (serial_console
- 1))
946 if (i
== num_channels
)
949 sunsab_console
.index
= i
;
950 register_console(&sunsab_console
);
953 static void __init
for_each_sab_edev(void (*callback
)(struct linux_ebus_device
*, void *), void *arg
)
955 struct linux_ebus
*ebus
;
956 struct linux_ebus_device
*edev
= NULL
;
958 for_each_ebus(ebus
) {
959 for_each_ebusdev(edev
, ebus
) {
960 if (!strcmp(edev
->prom_name
, "se")) {
963 } else if (!strcmp(edev
->prom_name
, "serial")) {
967 /* On RIO this can be an SE, check it. We could
968 * just check ebus->is_rio, but this is more portable.
970 clen
= prom_getproperty(edev
->prom_node
, "compatible",
971 compat
, sizeof(compat
));
973 if (strncmp(compat
, "sab82532", 8) == 0) {
983 static void __init
sab_count_callback(struct linux_ebus_device
*edev
, void *arg
)
990 static void __init
sab_attach_callback(struct linux_ebus_device
*edev
, void *arg
)
992 int *instance_p
= arg
;
993 struct uart_sunsab_port
*up
;
994 unsigned long regs
, offset
;
997 /* Note: ports are located in reverse order */
998 regs
= edev
->resource
[0].start
;
999 offset
= sizeof(union sab82532_async_regs
);
1000 for (i
= 0; i
< 2; i
++) {
1001 up
= &sunsab_ports
[(*instance_p
* 2) + 1 - i
];
1003 memset(up
, 0, sizeof(*up
));
1004 up
->regs
= ioremap(regs
+ offset
, sizeof(union sab82532_async_regs
));
1005 up
->port
.irq
= edev
->irqs
[0];
1006 up
->port
.fifosize
= SAB82532_XMIT_FIFO_SIZE
;
1007 up
->port
.mapbase
= (unsigned long)up
->regs
;
1008 up
->port
.iotype
= SERIAL_IO_MEM
;
1010 writeb(SAB82532_IPC_IC_ACT_LOW
, &up
->regs
->w
.ipc
);
1012 offset
-= sizeof(union sab82532_async_regs
);
1018 static int __init
probe_for_sabs(void)
1022 /* Find device instances. */
1023 for_each_sab_edev(&sab_count_callback
, &this_sab
);
1027 /* Allocate tables. */
1028 sunsab_ports
= kmalloc(sizeof(struct uart_sunsab_port
) * this_sab
* 2,
1033 num_channels
= this_sab
* 2;
1036 for_each_sab_edev(&sab_attach_callback
, &this_sab
);
1040 static void __init
sunsab_init_hw(void)
1044 for (i
= 0; i
< num_channels
; i
++) {
1045 struct uart_sunsab_port
*up
= &sunsab_ports
[i
];
1048 up
->port
.ops
= &sunsab_pops
;
1049 up
->port
.type
= PORT_SUNSAB
;
1050 up
->port
.uartclk
= SAB_BASE_BAUD
;
1052 up
->type
= readb(&up
->regs
->r
.vstr
) & 0x0f;
1053 writeb(~((1 << 1) | (1 << 2) | (1 << 4)), &up
->regs
->w
.pcr
);
1054 writeb(0xff, &up
->regs
->w
.pim
);
1055 if (up
->port
.line
== 0) {
1056 up
->pvr_dsr_bit
= (1 << 0);
1057 up
->pvr_dtr_bit
= (1 << 1);
1059 up
->pvr_dsr_bit
= (1 << 3);
1060 up
->pvr_dtr_bit
= (1 << 2);
1062 writeb((1 << 1) | (1 << 2) | (1 << 4), &up
->regs
->w
.pvr
);
1063 writeb(readb(&up
->regs
->rw
.mode
) | SAB82532_MODE_FRTS
,
1064 &up
->regs
->rw
.mode
);
1065 writeb(readb(&up
->regs
->rw
.mode
) | SAB82532_MODE_RTS
,
1066 &up
->regs
->rw
.mode
);
1068 up
->tec_timeout
= SAB82532_MAX_TEC_TIMEOUT
;
1069 up
->cec_timeout
= SAB82532_MAX_CEC_TIMEOUT
;
1071 if (!(up
->port
.line
& 0x01)) {
1072 if (request_irq(up
->port
.irq
, sunsab_interrupt
,
1073 SA_SHIRQ
, "serial(sab82532)", up
)) {
1074 printk("sunsab%d: can't get IRQ %x\n",
1082 static int __init
sunsab_init(void)
1084 int ret
= probe_for_sabs();
1092 sunsab_reg
.minor
= sunserial_current_minor
;
1093 sunsab_reg
.nr
= num_channels
;
1094 sunsab_reg
.cons
= &sunsab_console
;
1096 ret
= uart_register_driver(&sunsab_reg
);
1100 for (i
= 0; i
< num_channels
; i
++) {
1101 struct uart_sunsab_port
*up
= &sunsab_ports
[i
];
1103 if (!(up
->port
.line
& 0x01))
1104 free_irq(up
->port
.irq
, up
);
1107 kfree(sunsab_ports
);
1108 sunsab_ports
= NULL
;
1113 sunserial_current_minor
+= num_channels
;
1115 for (i
= 0; i
< num_channels
; i
++) {
1116 struct uart_sunsab_port
*up
= &sunsab_ports
[i
];
1118 uart_add_one_port(&sunsab_reg
, &up
->port
);
1121 sunsab_console_init();
1126 static void __exit
sunsab_exit(void)
1130 for (i
= 0; i
< num_channels
; i
++) {
1131 struct uart_sunsab_port
*up
= &sunsab_ports
[i
];
1133 uart_remove_one_port(&sunsab_reg
, &up
->port
);
1135 if (!(up
->port
.line
& 0x01))
1136 free_irq(up
->port
.irq
, up
);
1140 sunserial_current_minor
-= num_channels
;
1141 uart_unregister_driver(&sunsab_reg
);
1143 kfree(sunsab_ports
);
1144 sunsab_ports
= NULL
;
1147 module_init(sunsab_init
);
1148 module_exit(sunsab_exit
);
1150 MODULE_AUTHOR("Eddie C. Dost and David S. Miller");
1151 MODULE_DESCRIPTION("Sun SAB82532 serial port driver");
1152 MODULE_LICENSE("GPL");