svn commit: r242562 - in stable/9/sys/boot/i386: boot2 btx/btx gptboot zfsboot

[Andriy Gapon]

Author: avg
Date: Sun Nov  4 13:37:33 2012
New Revision: 242562
URL: http://svn.freebsd.org/changeset/base/242562

Log:
  MFC r241301: add detection of serial console presence to btx and
  boot2-like blocks

Modified:
  stable/9/sys/boot/i386/boot2/boot2.c
  stable/9/sys/boot/i386/boot2/lib.h
  stable/9/sys/boot/i386/boot2/sio.S
  stable/9/sys/boot/i386/btx/btx/btx.S
  stable/9/sys/boot/i386/gptboot/gptboot.c
  stable/9/sys/boot/i386/zfsboot/zfsboot.c
Directory Properties:
  stable/9/sys/   (props changed)
  stable/9/sys/boot/   (props changed)

Modified: stable/9/sys/boot/i386/boot2/boot2.c
==============================================================================
--- stable/9/sys/boot/i386/boot2/boot2.c	Sun Nov  4 13:33:59 2012	(r242561)
+++ stable/9/sys/boot/i386/boot2/boot2.c	Sun Nov  4 13:37:33 2012	(r242562)
@@ -416,8 +416,10 @@ parse()
 	    }
 	    ioctrl = OPT_CHECK(RBX_DUAL) ? (IO_SERIAL|IO_KEYBOARD) :
 		     OPT_CHECK(RBX_SERIAL) ? IO_SERIAL : IO_KEYBOARD;
-	    if (ioctrl & IO_SERIAL)
-	        sio_init(115200 / comspeed);
+	    if (ioctrl & IO_SERIAL) {
+	        if (sio_init(115200 / comspeed) != 0)
+		    ioctrl &= ~IO_SERIAL;
+	    }
 	} else {
 	    for (q = arg--; *q && *q != '('; q++);
 	    if (*q) {

Modified: stable/9/sys/boot/i386/boot2/lib.h
==============================================================================
--- stable/9/sys/boot/i386/boot2/lib.h	Sun Nov  4 13:33:59 2012	(r242561)
+++ stable/9/sys/boot/i386/boot2/lib.h	Sun Nov  4 13:37:33 2012	(r242562)
@@ -17,8 +17,8 @@
  * $FreeBSD$
  */
 
-void sio_init(int) __attribute__((regparm (3)));
-void sio_flush(void);
+int sio_init(int) __attribute__((regparm (3)));
+int sio_flush(void);
 void sio_putc(int) __attribute__((regparm (3)));
 int sio_getc(void);
 int sio_ischar(void);

Modified: stable/9/sys/boot/i386/boot2/sio.S
==============================================================================
--- stable/9/sys/boot/i386/boot2/sio.S	Sun Nov  4 13:33:59 2012	(r242561)
+++ stable/9/sys/boot/i386/boot2/sio.S	Sun Nov  4 13:37:33 2012	(r242562)
@@ -24,7 +24,7 @@
 		.globl sio_getc
 		.globl sio_ischar
 
-/* void sio_init(int div) */
+/* int sio_init(int div) */
 
 sio_init:	pushl %eax
 		movw $SIO_PRT+0x3,%dx		# Data format reg
@@ -43,12 +43,16 @@ sio_init:	pushl %eax
 		call sio_flush
 		ret
 
-/* void sio_flush(void) */
+/* int sio_flush(void) */
 
-sio_flush.0:	call sio_getc.1 		# Get character
-sio_flush:	call sio_ischar 		# Check for character
-		jnz sio_flush.0 		# Till none
-		ret				# To caller
+sio_flush:	xorl %eax,%eax			# Return value
+		xorl %ecx,%ecx			# Timeout
+		movb $0x80,%ch			#  counter
+sio_flush.1:	call sio_ischar 		# Check for character
+		jz sio_flush.2			# Till none
+		loop sio_flush.1		#  or counter is zero
+		movb $1, %al			# Exhausted all tries
+sio_flush.2:	ret				# To caller
 
 /* void sio_putc(int c) */
 

Modified: stable/9/sys/boot/i386/btx/btx/btx.S
==============================================================================
--- stable/9/sys/boot/i386/btx/btx/btx.S	Sun Nov  4 13:33:59 2012	(r242561)
+++ stable/9/sys/boot/i386/btx/btx/btx.S	Sun Nov  4 13:37:33 2012	(r242562)
@@ -812,7 +812,7 @@ putstr: 	lodsb				# Load char
 		.set SIO_DIV,(115200/SIOSPD)	# 115200 / SPD
 
 /*
- * void sio_init(void)
+ * int sio_init(void)
  */
 sio_init:	movw $SIO_PRT+0x3,%dx		# Data format reg
 		movb $SIO_FMT|0x80,%al		# Set format
@@ -828,14 +828,19 @@ sio_init:	movw $SIO_PRT+0x3,%dx		# Data 
 		movb $0x3,%al			# Set RTS,
 		outb %al,(%dx)			#  DTR
 		incl %edx			# Line status reg
+		call sio_getc.1 		# Get character
 
 /*
- * void sio_flush(void)
+ * int sio_flush(void)
  */
-sio_flush.0:	call sio_getc.1 		# Get character
-sio_flush:	call sio_ischar 		# Check for character
-		jnz sio_flush.0 		# Till none
-		ret				# To caller
+sio_flush:	xorl %eax,%eax			# Return value
+		xorl %ecx,%ecx			# Timeout
+		movb $0x80,%ch			#  counter
+sio_flush.1:	call sio_ischar 		# Check for character
+		jz sio_flush.2			# Till none
+		loop sio_flush.1		#  or counter is zero
+		movb $1, %al			# Exhausted all tries
+sio_flush.2:	ret				# To caller
 
 /*
  * void sio_putc(int c)

Modified: stable/9/sys/boot/i386/gptboot/gptboot.c
==============================================================================
--- stable/9/sys/boot/i386/gptboot/gptboot.c	Sun Nov  4 13:33:59 2012	(r242561)
+++ stable/9/sys/boot/i386/gptboot/gptboot.c	Sun Nov  4 13:37:33 2012	(r242562)
@@ -380,8 +380,10 @@ parse(char *cmdstr, int *dskupdated)
 	    }
 	    ioctrl = OPT_CHECK(RBX_DUAL) ? (IO_SERIAL|IO_KEYBOARD) :
 		     OPT_CHECK(RBX_SERIAL) ? IO_SERIAL : IO_KEYBOARD;
-	    if (ioctrl & IO_SERIAL)
-	        sio_init(115200 / comspeed);
+	    if (ioctrl & IO_SERIAL) {
+	        if (sio_init(115200 / comspeed) != 0)
+		    ioctrl &= ~IO_SERIAL;
+	    }
 	} else {
 	    for (q = arg--; *q && *q != '('; q++);
 	    if (*q) {

Modified: stable/9/sys/boot/i386/zfsboot/zfsboot.c
==============================================================================
--- stable/9/sys/boot/i386/zfsboot/zfsboot.c	Sun Nov  4 13:33:59 2012	(r242561)
+++ stable/9/sys/boot/i386/zfsboot/zfsboot.c	Sun Nov  4 13:37:33 2012	(r242562)
@@ -785,8 +785,10 @@ parse(void)
 	    }
 	    ioctrl = OPT_CHECK(RBX_DUAL) ? (IO_SERIAL|IO_KEYBOARD) :
 		     OPT_CHECK(RBX_SERIAL) ? IO_SERIAL : IO_KEYBOARD;
-	    if (ioctrl & IO_SERIAL)
-	        sio_init(115200 / comspeed);
+	    if (ioctrl & IO_SERIAL) {
+	        if (sio_init(115200 / comspeed) != 0)
+		    ioctrl &= ~IO_SERIAL;
+	    }
 	} if (c == '?') {
 	    dnode_phys_t dn;