Lines Matching full:up
104 static unsigned int serial_in(struct uart_sunsu_port *up, int offset) in serial_in() argument
106 offset <<= up->port.regshift; in serial_in()
108 switch (up->port.iotype) { in serial_in()
110 outb(up->port.hub6 - 1 + offset, up->port.iobase); in serial_in()
111 return inb(up->port.iobase + 1); in serial_in()
114 return readb(up->port.membase + offset); in serial_in()
117 return inb(up->port.iobase + offset); in serial_in()
121 static void serial_out(struct uart_sunsu_port *up, int offset, int value) in serial_out() argument
136 offset <<= up->port.regshift; in serial_out()
138 switch (up->port.iotype) { in serial_out()
140 outb(up->port.hub6 - 1 + offset, up->port.iobase); in serial_out()
141 outb(value, up->port.iobase + 1); in serial_out()
145 writeb(value, up->port.membase + offset); in serial_out()
149 outb(value, up->port.iobase + offset); in serial_out()
156 static void serial_icr_write(struct uart_sunsu_port *up, int offset, int value) in serial_icr_write() argument
158 serial_out(up, UART_SCR, offset); in serial_icr_write()
159 serial_out(up, UART_ICR, value); in serial_icr_write()
167 static int __enable_rsa(struct uart_sunsu_port *up) in __enable_rsa() argument
172 mode = serial_in(up, UART_RSA_MSR); in __enable_rsa()
176 serial_out(up, UART_RSA_MSR, mode | UART_RSA_MSR_FIFO); in __enable_rsa()
177 mode = serial_in(up, UART_RSA_MSR); in __enable_rsa()
182 up->port.uartclk = SERIAL_RSA_BAUD_BASE * 16; in __enable_rsa()
187 static void enable_rsa(struct uart_sunsu_port *up) in enable_rsa() argument
189 if (up->port.type == PORT_RSA) { in enable_rsa()
190 if (up->port.uartclk != SERIAL_RSA_BAUD_BASE * 16) { in enable_rsa()
191 uart_port_lock_irq(&up->port); in enable_rsa()
192 __enable_rsa(up); in enable_rsa()
193 uart_port_unlock_irq(&up->port); in enable_rsa()
195 if (up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16) in enable_rsa()
196 serial_out(up, UART_RSA_FRR, 0); in enable_rsa()
206 static void disable_rsa(struct uart_sunsu_port *up) in disable_rsa() argument
211 if (up->port.type == PORT_RSA && in disable_rsa()
212 up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16) { in disable_rsa()
213 uart_port_lock_irq(&up->port); in disable_rsa()
215 mode = serial_in(up, UART_RSA_MSR); in disable_rsa()
219 serial_out(up, UART_RSA_MSR, mode & ~UART_RSA_MSR_FIFO); in disable_rsa()
220 mode = serial_in(up, UART_RSA_MSR); in disable_rsa()
225 up->port.uartclk = SERIAL_RSA_BAUD_BASE_LO * 16; in disable_rsa()
226 uart_port_unlock_irq(&up->port); in disable_rsa()
241 struct uart_sunsu_port *up = in sunsu_stop_tx() local
244 __stop_tx(up); in sunsu_stop_tx()
249 if (up->port.type == PORT_16C950) { in sunsu_stop_tx()
250 up->acr |= UART_ACR_TXDIS; in sunsu_stop_tx()
251 serial_icr_write(up, UART_ACR, up->acr); in sunsu_stop_tx()
257 struct uart_sunsu_port *up = in sunsu_start_tx() local
260 if (!(up->ier & UART_IER_THRI)) { in sunsu_start_tx()
261 up->ier |= UART_IER_THRI; in sunsu_start_tx()
262 serial_out(up, UART_IER, up->ier); in sunsu_start_tx()
268 if (up->port.type == PORT_16C950 && up->acr & UART_ACR_TXDIS) { in sunsu_start_tx()
269 up->acr &= ~UART_ACR_TXDIS; in sunsu_start_tx()
270 serial_icr_write(up, UART_ACR, up->acr); in sunsu_start_tx()
276 struct uart_sunsu_port *up = in sunsu_stop_rx() local
279 up->ier &= ~UART_IER_RLSI; in sunsu_stop_rx()
280 up->port.read_status_mask &= ~UART_LSR_DR; in sunsu_stop_rx()
281 serial_out(up, UART_IER, up->ier); in sunsu_stop_rx()
286 struct uart_sunsu_port *up = in sunsu_enable_ms() local
290 uart_port_lock_irqsave(&up->port, &flags); in sunsu_enable_ms()
291 up->ier |= UART_IER_MSI; in sunsu_enable_ms()
292 serial_out(up, UART_IER, up->ier); in sunsu_enable_ms()
293 uart_port_unlock_irqrestore(&up->port, flags); in sunsu_enable_ms()
297 receive_chars(struct uart_sunsu_port *up, unsigned char *status) in receive_chars() argument
299 struct tty_port *port = &up->port.state->port; in receive_chars()
305 ch = serial_in(up, UART_RX); in receive_chars()
307 up->port.icount.rx++; in receive_chars()
316 up->port.icount.brk++; in receive_chars()
317 if (up->port.cons != NULL && in receive_chars()
318 up->port.line == up->port.cons->index) in receive_chars()
326 if (uart_handle_break(&up->port)) in receive_chars()
329 up->port.icount.parity++; in receive_chars()
331 up->port.icount.frame++; in receive_chars()
333 up->port.icount.overrun++; in receive_chars()
338 *status &= up->port.read_status_mask; in receive_chars()
340 if (up->port.cons != NULL && in receive_chars()
341 up->port.line == up->port.cons->index) { in receive_chars()
343 *status |= up->lsr_break_flag; in receive_chars()
344 up->lsr_break_flag = 0; in receive_chars()
354 if (uart_handle_sysrq_char(&up->port, ch)) in receive_chars()
356 if ((*status & up->port.ignore_status_mask) == 0) in receive_chars()
366 *status = serial_in(up, UART_LSR); in receive_chars()
373 static void transmit_chars(struct uart_sunsu_port *up) in transmit_chars() argument
375 struct tty_port *tport = &up->port.state->port; in transmit_chars()
379 if (up->port.x_char) { in transmit_chars()
380 serial_out(up, UART_TX, up->port.x_char); in transmit_chars()
381 up->port.icount.tx++; in transmit_chars()
382 up->port.x_char = 0; in transmit_chars()
385 if (uart_tx_stopped(&up->port)) { in transmit_chars()
386 sunsu_stop_tx(&up->port); in transmit_chars()
390 __stop_tx(up); in transmit_chars()
394 count = up->port.fifosize; in transmit_chars()
396 if (!uart_fifo_get(&up->port, &ch)) in transmit_chars()
399 serial_out(up, UART_TX, ch); in transmit_chars()
403 uart_write_wakeup(&up->port); in transmit_chars()
406 __stop_tx(up); in transmit_chars()
409 static void check_modem_status(struct uart_sunsu_port *up) in check_modem_status() argument
413 status = serial_in(up, UART_MSR); in check_modem_status()
419 up->port.icount.rng++; in check_modem_status()
421 up->port.icount.dsr++; in check_modem_status()
423 uart_handle_dcd_change(&up->port, status & UART_MSR_DCD); in check_modem_status()
425 uart_handle_cts_change(&up->port, status & UART_MSR_CTS); in check_modem_status()
427 wake_up_interruptible(&up->port.state->port.delta_msr_wait); in check_modem_status()
432 struct uart_sunsu_port *up = dev_id; in sunsu_serial_interrupt() local
436 uart_port_lock_irqsave(&up->port, &flags); in sunsu_serial_interrupt()
439 status = serial_in(up, UART_LSR); in sunsu_serial_interrupt()
441 receive_chars(up, &status); in sunsu_serial_interrupt()
442 check_modem_status(up); in sunsu_serial_interrupt()
444 transmit_chars(up); in sunsu_serial_interrupt()
446 tty_flip_buffer_push(&up->port.state->port); in sunsu_serial_interrupt()
448 } while (!(serial_in(up, UART_IIR) & UART_IIR_NO_INT)); in sunsu_serial_interrupt()
450 uart_port_unlock_irqrestore(&up->port, flags); in sunsu_serial_interrupt()
461 static void sunsu_change_mouse_baud(struct uart_sunsu_port *up) in sunsu_change_mouse_baud() argument
463 unsigned int cur_cflag = up->cflag; in sunsu_change_mouse_baud()
466 up->cflag &= ~CBAUD; in sunsu_change_mouse_baud()
467 up->cflag |= suncore_mouse_baud_cflag_next(cur_cflag, &new_baud); in sunsu_change_mouse_baud()
469 quot = up->port.uartclk / (16 * new_baud); in sunsu_change_mouse_baud()
471 sunsu_change_speed(&up->port, up->cflag, 0, quot); in sunsu_change_mouse_baud()
474 static void receive_kbd_ms_chars(struct uart_sunsu_port *up, int is_break) in receive_kbd_ms_chars() argument
477 unsigned char ch = serial_in(up, UART_RX); in receive_kbd_ms_chars()
480 if (up->su_type == SU_PORT_KBD) { in receive_kbd_ms_chars()
482 serio_interrupt(&up->serio, ch, 0); in receive_kbd_ms_chars()
484 } else if (up->su_type == SU_PORT_MS) { in receive_kbd_ms_chars()
489 sunsu_change_mouse_baud(up); in receive_kbd_ms_chars()
496 serio_interrupt(&up->serio, ch, 0); in receive_kbd_ms_chars()
501 } while (serial_in(up, UART_LSR) & UART_LSR_DR); in receive_kbd_ms_chars()
506 struct uart_sunsu_port *up = dev_id; in sunsu_kbd_ms_interrupt() local
508 if (!(serial_in(up, UART_IIR) & UART_IIR_NO_INT)) { in sunsu_kbd_ms_interrupt()
509 unsigned char status = serial_in(up, UART_LSR); in sunsu_kbd_ms_interrupt()
512 receive_kbd_ms_chars(up, (status & UART_LSR_BI) != 0); in sunsu_kbd_ms_interrupt()
520 struct uart_sunsu_port *up = in sunsu_tx_empty() local
525 uart_port_lock_irqsave(&up->port, &flags); in sunsu_tx_empty()
526 ret = serial_in(up, UART_LSR) & UART_LSR_TEMT ? TIOCSER_TEMT : 0; in sunsu_tx_empty()
527 uart_port_unlock_irqrestore(&up->port, flags); in sunsu_tx_empty()
534 struct uart_sunsu_port *up = in sunsu_get_mctrl() local
539 status = serial_in(up, UART_MSR); in sunsu_get_mctrl()
555 struct uart_sunsu_port *up = in sunsu_set_mctrl() local
570 serial_out(up, UART_MCR, mcr); in sunsu_set_mctrl()
575 struct uart_sunsu_port *up = in sunsu_break_ctl() local
579 uart_port_lock_irqsave(&up->port, &flags); in sunsu_break_ctl()
581 up->lcr |= UART_LCR_SBC; in sunsu_break_ctl()
583 up->lcr &= ~UART_LCR_SBC; in sunsu_break_ctl()
584 serial_out(up, UART_LCR, up->lcr); in sunsu_break_ctl()
585 uart_port_unlock_irqrestore(&up->port, flags); in sunsu_break_ctl()
590 struct uart_sunsu_port *up = in sunsu_startup() local
595 if (up->port.type == PORT_16C950) { in sunsu_startup()
596 /* Wake up and initialize UART */ in sunsu_startup()
597 up->acr = 0; in sunsu_startup()
598 serial_out(up, UART_LCR, 0xBF); in sunsu_startup()
599 serial_out(up, UART_EFR, UART_EFR_ECB); in sunsu_startup()
600 serial_out(up, UART_IER, 0); in sunsu_startup()
601 serial_out(up, UART_LCR, 0); in sunsu_startup()
602 serial_icr_write(up, UART_CSR, 0); /* Reset the UART */ in sunsu_startup()
603 serial_out(up, UART_LCR, 0xBF); in sunsu_startup()
604 serial_out(up, UART_EFR, UART_EFR_ECB); in sunsu_startup()
605 serial_out(up, UART_LCR, 0); in sunsu_startup()
610 * If this is an RSA port, see if we can kick it up to the in sunsu_startup()
613 enable_rsa(up); in sunsu_startup()
620 if (uart_config[up->port.type].flags & UART_CLEAR_FIFO) { in sunsu_startup()
621 serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO); in sunsu_startup()
622 serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO | in sunsu_startup()
624 serial_out(up, UART_FCR, 0); in sunsu_startup()
630 (void) serial_in(up, UART_LSR); in sunsu_startup()
631 (void) serial_in(up, UART_RX); in sunsu_startup()
632 (void) serial_in(up, UART_IIR); in sunsu_startup()
633 (void) serial_in(up, UART_MSR); in sunsu_startup()
640 if (!(up->port.flags & UPF_BUGGY_UART) && in sunsu_startup()
641 (serial_in(up, UART_LSR) == 0xff)) { in sunsu_startup()
642 printk("ttyS%d: LSR safety check engaged!\n", up->port.line); in sunsu_startup()
646 if (up->su_type != SU_PORT_PORT) { in sunsu_startup()
647 retval = request_irq(up->port.irq, sunsu_kbd_ms_interrupt, in sunsu_startup()
648 IRQF_SHARED, su_typev[up->su_type], up); in sunsu_startup()
650 retval = request_irq(up->port.irq, sunsu_serial_interrupt, in sunsu_startup()
651 IRQF_SHARED, su_typev[up->su_type], up); in sunsu_startup()
654 printk("su: Cannot register IRQ %d\n", up->port.irq); in sunsu_startup()
661 serial_out(up, UART_LCR, UART_LCR_WLEN8); in sunsu_startup()
663 uart_port_lock_irqsave(&up->port, &flags); in sunsu_startup()
665 up->port.mctrl |= TIOCM_OUT2; in sunsu_startup()
667 sunsu_set_mctrl(&up->port, up->port.mctrl); in sunsu_startup()
668 uart_port_unlock_irqrestore(&up->port, flags); in sunsu_startup()
675 up->ier = UART_IER_RLSI | UART_IER_RDI; in sunsu_startup()
676 serial_out(up, UART_IER, up->ier); in sunsu_startup()
678 if (up->port.flags & UPF_FOURPORT) { in sunsu_startup()
683 icp = (up->port.iobase & 0xfe0) | 0x01f; in sunsu_startup()
691 (void) serial_in(up, UART_LSR); in sunsu_startup()
692 (void) serial_in(up, UART_RX); in sunsu_startup()
693 (void) serial_in(up, UART_IIR); in sunsu_startup()
694 (void) serial_in(up, UART_MSR); in sunsu_startup()
701 struct uart_sunsu_port *up = in sunsu_shutdown() local
708 up->ier = 0; in sunsu_shutdown()
709 serial_out(up, UART_IER, 0); in sunsu_shutdown()
711 uart_port_lock_irqsave(&up->port, &flags); in sunsu_shutdown()
712 if (up->port.flags & UPF_FOURPORT) { in sunsu_shutdown()
714 inb((up->port.iobase & 0xfe0) | 0x1f); in sunsu_shutdown()
715 up->port.mctrl |= TIOCM_OUT1; in sunsu_shutdown()
717 up->port.mctrl &= ~TIOCM_OUT2; in sunsu_shutdown()
719 sunsu_set_mctrl(&up->port, up->port.mctrl); in sunsu_shutdown()
720 uart_port_unlock_irqrestore(&up->port, flags); in sunsu_shutdown()
725 serial_out(up, UART_LCR, serial_in(up, UART_LCR) & ~UART_LCR_SBC); in sunsu_shutdown()
726 serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO | in sunsu_shutdown()
729 serial_out(up, UART_FCR, 0); in sunsu_shutdown()
735 disable_rsa(up); in sunsu_shutdown()
741 (void) serial_in(up, UART_RX); in sunsu_shutdown()
743 free_irq(up->port.irq, up); in sunsu_shutdown()
750 struct uart_sunsu_port *up = in sunsu_change_speed() local
785 if ((quot & 0xff) == 0 && up->port.type == PORT_16C950 && in sunsu_change_speed()
786 up->rev == 0x5201) in sunsu_change_speed()
789 if (uart_config[up->port.type].flags & UART_USE_FIFO) { in sunsu_change_speed()
790 if ((up->port.uartclk / quot) < (2400 * 16)) in sunsu_change_speed()
793 else if (up->port.type == PORT_RSA) in sunsu_change_speed()
799 if (up->port.type == PORT_16750) in sunsu_change_speed()
806 uart_port_lock_irqsave(&up->port, &flags); in sunsu_change_speed()
813 up->port.read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR; in sunsu_change_speed()
815 up->port.read_status_mask |= UART_LSR_FE | UART_LSR_PE; in sunsu_change_speed()
817 up->port.read_status_mask |= UART_LSR_BI; in sunsu_change_speed()
822 up->port.ignore_status_mask = 0; in sunsu_change_speed()
824 up->port.ignore_status_mask |= UART_LSR_PE | UART_LSR_FE; in sunsu_change_speed()
826 up->port.ignore_status_mask |= UART_LSR_BI; in sunsu_change_speed()
832 up->port.ignore_status_mask |= UART_LSR_OE; in sunsu_change_speed()
839 up->port.ignore_status_mask |= UART_LSR_DR; in sunsu_change_speed()
844 up->ier &= ~UART_IER_MSI; in sunsu_change_speed()
845 if (UART_ENABLE_MS(&up->port, cflag)) in sunsu_change_speed()
846 up->ier |= UART_IER_MSI; in sunsu_change_speed()
848 serial_out(up, UART_IER, up->ier); in sunsu_change_speed()
850 if (uart_config[up->port.type].flags & UART_STARTECH) { in sunsu_change_speed()
851 serial_out(up, UART_LCR, 0xBF); in sunsu_change_speed()
852 serial_out(up, UART_EFR, cflag & CRTSCTS ? UART_EFR_CTS :0); in sunsu_change_speed()
854 serial_out(up, UART_LCR, cval | UART_LCR_DLAB);/* set DLAB */ in sunsu_change_speed()
855 serial_out(up, UART_DLL, quot & 0xff); /* LS of divisor */ in sunsu_change_speed()
856 serial_out(up, UART_DLM, quot >> 8); /* MS of divisor */ in sunsu_change_speed()
857 if (up->port.type == PORT_16750) in sunsu_change_speed()
858 serial_out(up, UART_FCR, fcr); /* set fcr */ in sunsu_change_speed()
859 serial_out(up, UART_LCR, cval); /* reset DLAB */ in sunsu_change_speed()
860 up->lcr = cval; /* Save LCR */ in sunsu_change_speed()
861 if (up->port.type != PORT_16750) { in sunsu_change_speed()
864 serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO); in sunsu_change_speed()
866 serial_out(up, UART_FCR, fcr); /* set fcr */ in sunsu_change_speed()
869 up->cflag = cflag; in sunsu_change_speed()
871 uart_port_unlock_irqrestore(&up->port, flags); in sunsu_change_speed()
900 struct uart_sunsu_port *up = in sunsu_config_port() local
909 port->type = up->type_probed; /* XXX */ in sunsu_config_port()
959 struct uart_sunsu_port *up = serio->port_data; in sunsu_serio_write() local
966 lsr = serial_in(up, UART_LSR); in sunsu_serio_write()
970 serial_out(up, UART_TX, ch); in sunsu_serio_write()
979 struct uart_sunsu_port *up = serio->port_data; in sunsu_serio_open() local
984 if (!up->serio_open) { in sunsu_serio_open()
985 up->serio_open = 1; in sunsu_serio_open()
996 struct uart_sunsu_port *up = serio->port_data; in sunsu_serio_close() local
1000 up->serio_open = 0; in sunsu_serio_close()
1006 static void sunsu_autoconfig(struct uart_sunsu_port *up) in sunsu_autoconfig() argument
1012 if (up->su_type == SU_PORT_NONE) in sunsu_autoconfig()
1015 up->type_probed = PORT_UNKNOWN; in sunsu_autoconfig()
1016 up->port.iotype = UPIO_MEM; in sunsu_autoconfig()
1018 uart_port_lock_irqsave(&up->port, &flags); in sunsu_autoconfig()
1020 if (!(up->port.flags & UPF_BUGGY_UART)) { in sunsu_autoconfig()
1030 scratch = serial_in(up, UART_IER); in sunsu_autoconfig()
1031 serial_out(up, UART_IER, 0); in sunsu_autoconfig()
1035 scratch2 = serial_in(up, UART_IER); in sunsu_autoconfig()
1036 serial_out(up, UART_IER, 0x0f); in sunsu_autoconfig()
1040 scratch3 = serial_in(up, UART_IER); in sunsu_autoconfig()
1041 serial_out(up, UART_IER, scratch); in sunsu_autoconfig()
1046 save_mcr = serial_in(up, UART_MCR); in sunsu_autoconfig()
1047 save_lcr = serial_in(up, UART_LCR); in sunsu_autoconfig()
1058 if (!(up->port.flags & UPF_SKIP_TEST)) { in sunsu_autoconfig()
1059 serial_out(up, UART_MCR, UART_MCR_LOOP | 0x0A); in sunsu_autoconfig()
1060 status1 = serial_in(up, UART_MSR) & 0xF0; in sunsu_autoconfig()
1061 serial_out(up, UART_MCR, save_mcr); in sunsu_autoconfig()
1065 serial_out(up, UART_LCR, 0xBF); /* set up for StarTech test */ in sunsu_autoconfig()
1066 serial_out(up, UART_EFR, 0); /* EFR is the same as FCR */ in sunsu_autoconfig()
1067 serial_out(up, UART_LCR, 0); in sunsu_autoconfig()
1068 serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO); in sunsu_autoconfig()
1069 scratch = serial_in(up, UART_IIR) >> 6; in sunsu_autoconfig()
1072 up->port.type = PORT_16450; in sunsu_autoconfig()
1075 up->port.type = PORT_UNKNOWN; in sunsu_autoconfig()
1078 up->port.type = PORT_16550; in sunsu_autoconfig()
1081 up->port.type = PORT_16550A; in sunsu_autoconfig()
1084 if (up->port.type == PORT_16550A) { in sunsu_autoconfig()
1086 serial_out(up, UART_LCR, UART_LCR_DLAB); in sunsu_autoconfig()
1087 if (serial_in(up, UART_EFR) == 0) { in sunsu_autoconfig()
1088 up->port.type = PORT_16650; in sunsu_autoconfig()
1090 serial_out(up, UART_LCR, 0xBF); in sunsu_autoconfig()
1091 if (serial_in(up, UART_EFR) == 0) in sunsu_autoconfig()
1092 up->port.type = PORT_16650V2; in sunsu_autoconfig()
1095 if (up->port.type == PORT_16550A) { in sunsu_autoconfig()
1097 serial_out(up, UART_LCR, save_lcr | UART_LCR_DLAB); in sunsu_autoconfig()
1098 serial_out(up, UART_FCR, in sunsu_autoconfig()
1100 scratch = serial_in(up, UART_IIR) >> 5; in sunsu_autoconfig()
1108 serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO); in sunsu_autoconfig()
1109 serial_out(up, UART_LCR, 0); in sunsu_autoconfig()
1110 serial_out(up, UART_FCR, in sunsu_autoconfig()
1112 scratch = serial_in(up, UART_IIR) >> 5; in sunsu_autoconfig()
1114 up->port.type = PORT_16750; in sunsu_autoconfig()
1116 serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO); in sunsu_autoconfig()
1118 serial_out(up, UART_LCR, save_lcr); in sunsu_autoconfig()
1119 if (up->port.type == PORT_16450) { in sunsu_autoconfig()
1120 scratch = serial_in(up, UART_SCR); in sunsu_autoconfig()
1121 serial_out(up, UART_SCR, 0xa5); in sunsu_autoconfig()
1122 status1 = serial_in(up, UART_SCR); in sunsu_autoconfig()
1123 serial_out(up, UART_SCR, 0x5a); in sunsu_autoconfig()
1124 status2 = serial_in(up, UART_SCR); in sunsu_autoconfig()
1125 serial_out(up, UART_SCR, scratch); in sunsu_autoconfig()
1128 up->port.type = PORT_8250; in sunsu_autoconfig()
1131 up->port.fifosize = uart_config[up->port.type].dfl_xmit_fifo_size; in sunsu_autoconfig()
1133 if (up->port.type == PORT_UNKNOWN) in sunsu_autoconfig()
1135 up->type_probed = up->port.type; /* XXX */ in sunsu_autoconfig()
1141 if (up->port.type == PORT_RSA) in sunsu_autoconfig()
1142 serial_out(up, UART_RSA_FRR, 0); in sunsu_autoconfig()
1144 serial_out(up, UART_MCR, save_mcr); in sunsu_autoconfig()
1145 serial_out(up, UART_FCR, (UART_FCR_ENABLE_FIFO | in sunsu_autoconfig()
1148 serial_out(up, UART_FCR, 0); in sunsu_autoconfig()
1149 (void)serial_in(up, UART_RX); in sunsu_autoconfig()
1150 serial_out(up, UART_IER, 0); in sunsu_autoconfig()
1153 uart_port_unlock_irqrestore(&up->port, flags); in sunsu_autoconfig()
1163 static int sunsu_kbd_ms_init(struct uart_sunsu_port *up) in sunsu_kbd_ms_init() argument
1170 if (up->su_type == SU_PORT_KBD) { in sunsu_kbd_ms_init()
1171 up->cflag = B1200 | CS8 | CLOCAL | CREAD; in sunsu_kbd_ms_init()
1174 up->cflag = B4800 | CS8 | CLOCAL | CREAD; in sunsu_kbd_ms_init()
1177 quot = up->port.uartclk / (16 * baud); in sunsu_kbd_ms_init()
1179 sunsu_autoconfig(up); in sunsu_kbd_ms_init()
1180 if (up->port.type == PORT_UNKNOWN) in sunsu_kbd_ms_init()
1184 up->port.dev->of_node, in sunsu_kbd_ms_init()
1185 (up->su_type == SU_PORT_KBD) ? "Keyboard" : "Mouse", in sunsu_kbd_ms_init()
1186 (unsigned long long) up->port.mapbase, in sunsu_kbd_ms_init()
1187 up->port.irq); in sunsu_kbd_ms_init()
1190 serio = &up->serio; in sunsu_kbd_ms_init()
1191 serio->port_data = up; in sunsu_kbd_ms_init()
1194 if (up->su_type == SU_PORT_KBD) { in sunsu_kbd_ms_init()
1203 (!(up->port.line & 1) ? "su/serio0" : "su/serio1"), in sunsu_kbd_ms_init()
1209 serio->dev.parent = up->port.dev; in sunsu_kbd_ms_init()
1214 sunsu_change_speed(&up->port, up->cflag, 0, quot); in sunsu_kbd_ms_init()
1216 sunsu_startup(&up->port); in sunsu_kbd_ms_init()
1231 static void wait_for_xmitr(struct uart_sunsu_port *up) in wait_for_xmitr() argument
1235 /* Wait up to 10ms for the character(s) to be sent. */ in wait_for_xmitr()
1237 status = serial_in(up, UART_LSR); in wait_for_xmitr()
1240 up->lsr_break_flag = UART_LSR_BI; in wait_for_xmitr()
1247 /* Wait up to 1s for flow control if necessary */ in wait_for_xmitr()
1248 if (up->port.flags & UPF_CONS_FLOW) { in wait_for_xmitr()
1251 ((serial_in(up, UART_MSR) & UART_MSR_CTS) == 0)) in wait_for_xmitr()
1258 struct uart_sunsu_port *up = in sunsu_console_putchar() local
1261 wait_for_xmitr(up); in sunsu_console_putchar()
1262 serial_out(up, UART_TX, ch); in sunsu_console_putchar()
1272 struct uart_sunsu_port *up = &sunsu_ports[co->index]; in sunsu_console_write() local
1277 if (up->port.sysrq || oops_in_progress) in sunsu_console_write()
1278 locked = uart_port_trylock_irqsave(&up->port, &flags); in sunsu_console_write()
1280 uart_port_lock_irqsave(&up->port, &flags); in sunsu_console_write()
1285 ier = serial_in(up, UART_IER); in sunsu_console_write()
1286 serial_out(up, UART_IER, 0); in sunsu_console_write()
1288 uart_console_write(&up->port, s, count, sunsu_console_putchar); in sunsu_console_write()
1294 wait_for_xmitr(up); in sunsu_console_write()
1295 serial_out(up, UART_IER, ier); in sunsu_console_write()
1298 uart_port_unlock_irqrestore(&up->port, flags); in sunsu_console_write()
1389 struct uart_sunsu_port *up; in su_probe() local
1399 up = &sunsu_ports[nr_inst]; in su_probe()
1401 up = kzalloc(sizeof(*up), GFP_KERNEL); in su_probe()
1402 if (!up) in su_probe()
1406 up->port.line = nr_inst; in su_probe()
1408 spin_lock_init(&up->port.lock); in su_probe()
1410 up->su_type = type; in su_probe()
1413 up->port.mapbase = rp->start; in su_probe()
1414 up->reg_size = resource_size(rp); in su_probe()
1415 up->port.membase = of_ioremap(rp, 0, up->reg_size, "su"); in su_probe()
1416 if (!up->port.membase) { in su_probe()
1418 kfree(up); in su_probe()
1422 up->port.irq = op->archdata.irqs[0]; in su_probe()
1424 up->port.dev = &op->dev; in su_probe()
1426 up->port.type = PORT_UNKNOWN; in su_probe()
1427 up->port.uartclk = (SU_BASE_BAUD * 16); in su_probe()
1428 up->port.has_sysrq = IS_ENABLED(CONFIG_SERIAL_SUNSU_CONSOLE); in su_probe()
1431 if (up->su_type == SU_PORT_KBD || up->su_type == SU_PORT_MS) { in su_probe()
1432 err = sunsu_kbd_ms_init(up); in su_probe()
1435 up->port.membase, up->reg_size); in su_probe()
1436 kfree(up); in su_probe()
1439 platform_set_drvdata(op, up); in su_probe()
1446 up->port.flags |= UPF_BOOT_AUTOCONF; in su_probe()
1448 sunsu_autoconfig(up); in su_probe()
1451 if (up->port.type == PORT_UNKNOWN) in su_probe()
1454 up->port.ops = &sunsu_pops; in su_probe()
1462 &sunsu_reg, up->port.line, in su_probe()
1464 err = uart_add_one_port(&sunsu_reg, &up->port); in su_probe()
1468 platform_set_drvdata(op, up); in su_probe()
1475 of_iounmap(&op->resource[0], up->port.membase, up->reg_size); in su_probe()
1476 kfree(up); in su_probe()
1482 struct uart_sunsu_port *up = platform_get_drvdata(op); in su_remove() local
1485 if (up->su_type == SU_PORT_MS || in su_remove()
1486 up->su_type == SU_PORT_KBD) in su_remove()
1491 serio_unregister_port(&up->serio); in su_remove()
1493 } else if (up->port.type != PORT_UNKNOWN) in su_remove()
1494 uart_remove_one_port(&sunsu_reg, &up->port); in su_remove()
1496 if (up->port.membase) in su_remove()
1497 of_iounmap(&op->resource[0], up->port.membase, up->reg_size); in su_remove()
1500 kfree(up); in su_remove()