|
@@ -1285,6 +1285,7 @@ static struct uart_driver sunsu_reg = {
|
|
|
|
|
|
static int __init sunsu_kbd_ms_init(struct uart_sunsu_port *up, int channel)
|
|
static int __init sunsu_kbd_ms_init(struct uart_sunsu_port *up, int channel)
|
|
{
|
|
{
|
|
|
|
+ int quot, baud;
|
|
#ifdef CONFIG_SERIO
|
|
#ifdef CONFIG_SERIO
|
|
struct serio *serio;
|
|
struct serio *serio;
|
|
#endif
|
|
#endif
|
|
@@ -1293,10 +1294,14 @@ static int __init sunsu_kbd_ms_init(struct uart_sunsu_port *up, int channel)
|
|
up->port.type = PORT_UNKNOWN;
|
|
up->port.type = PORT_UNKNOWN;
|
|
up->port.uartclk = (SU_BASE_BAUD * 16);
|
|
up->port.uartclk = (SU_BASE_BAUD * 16);
|
|
|
|
|
|
- if (up->su_type == SU_PORT_KBD)
|
|
|
|
|
|
+ if (up->su_type == SU_PORT_KBD) {
|
|
up->cflag = B1200 | CS8 | CLOCAL | CREAD;
|
|
up->cflag = B1200 | CS8 | CLOCAL | CREAD;
|
|
- else
|
|
|
|
|
|
+ baud = 1200;
|
|
|
|
+ } else {
|
|
up->cflag = B4800 | CS8 | CLOCAL | CREAD;
|
|
up->cflag = B4800 | CS8 | CLOCAL | CREAD;
|
|
|
|
+ baud = 4800;
|
|
|
|
+ }
|
|
|
|
+ quot = up->port.uartclk / (16 * baud);
|
|
|
|
|
|
sunsu_autoconfig(up);
|
|
sunsu_autoconfig(up);
|
|
if (up->port.type == PORT_UNKNOWN)
|
|
if (up->port.type == PORT_UNKNOWN)
|
|
@@ -1337,6 +1342,8 @@ static int __init sunsu_kbd_ms_init(struct uart_sunsu_port *up, int channel)
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
|
|
|
|
+ sunsu_change_speed(&up->port, up->cflag, 0, quot);
|
|
|
|
+
|
|
sunsu_startup(&up->port);
|
|
sunsu_startup(&up->port);
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|