Jelajahi Sumber

rocket: first pass at termios reporting

Also removes a cflag comparison that caused some mode changes to get wrongly
ignored

Signed-off-by: Alan Cox <alan@redhat.com>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
Alan Cox 17 tahun lalu
induk
melakukan
6df3526b66
1 mengubah file dengan 8 tambahan dan 10 penghapusan
  1. 8 10
      drivers/char/rocket.c

+ 8 - 10
drivers/char/rocket.c

@@ -715,11 +715,10 @@ static void configure_r_port(struct r_port *info,
 	unsigned rocketMode;
 	unsigned rocketMode;
 	int bits, baud, divisor;
 	int bits, baud, divisor;
 	CHANNEL_t *cp;
 	CHANNEL_t *cp;
+	struct ktermios *t = info->tty->termios;
 
 
-	if (!info->tty || !info->tty->termios)
-		return;
 	cp = &info->channel;
 	cp = &info->channel;
-	cflag = info->tty->termios->c_cflag;
+	cflag = t->c_cflag;
 
 
 	/* Byte size and parity */
 	/* Byte size and parity */
 	if ((cflag & CSIZE) == CS8) {
 	if ((cflag & CSIZE) == CS8) {
@@ -754,10 +753,7 @@ static void configure_r_port(struct r_port *info,
 		baud = 9600;
 		baud = 9600;
 	divisor = ((rp_baud_base[info->board] + (baud >> 1)) / baud) - 1;
 	divisor = ((rp_baud_base[info->board] + (baud >> 1)) / baud) - 1;
 	if ((divisor >= 8192 || divisor < 0) && old_termios) {
 	if ((divisor >= 8192 || divisor < 0) && old_termios) {
-		info->tty->termios->c_cflag &= ~CBAUD;
-		info->tty->termios->c_cflag |=
-		    (old_termios->c_cflag & CBAUD);
-		baud = tty_get_baud_rate(info->tty);
+		baud = tty_termios_baud_rate(old_termios);
 		if (!baud)
 		if (!baud)
 			baud = 9600;
 			baud = 9600;
 		divisor = (rp_baud_base[info->board] / baud) - 1;
 		divisor = (rp_baud_base[info->board] / baud) - 1;
@@ -769,6 +765,9 @@ static void configure_r_port(struct r_port *info,
 	info->cps = baud / bits;
 	info->cps = baud / bits;
 	sSetBaud(cp, divisor);
 	sSetBaud(cp, divisor);
 
 
+	/* FIXME: Should really back compute a baud rate from the divisor */
+	tty_encode_baud_rate(info->tty, baud, baud);
+
 	if (cflag & CRTSCTS) {
 	if (cflag & CRTSCTS) {
 		info->intmask |= DELTA_CTS;
 		info->intmask |= DELTA_CTS;
 		sEnCTSFlowCtl(cp);
 		sEnCTSFlowCtl(cp);
@@ -1202,15 +1201,14 @@ static void rp_set_termios(struct tty_struct *tty,
 
 
 	cflag = tty->termios->c_cflag;
 	cflag = tty->termios->c_cflag;
 
 
-	if (cflag == old_termios->c_cflag)
-		return;
-
 	/*
 	/*
 	 * This driver doesn't support CS5 or CS6
 	 * This driver doesn't support CS5 or CS6
 	 */
 	 */
 	if (((cflag & CSIZE) == CS5) || ((cflag & CSIZE) == CS6))
 	if (((cflag & CSIZE) == CS5) || ((cflag & CSIZE) == CS6))
 		tty->termios->c_cflag =
 		tty->termios->c_cflag =
 		    ((cflag & ~CSIZE) | (old_termios->c_cflag & CSIZE));
 		    ((cflag & ~CSIZE) | (old_termios->c_cflag & CSIZE));
+	/* Or CMSPAR */
+	tty->termios->c_cflag &= ~CMSPAR;
 
 
 	configure_r_port(info, old_termios);
 	configure_r_port(info, old_termios);