add detection of serial console presence to btx and boot2-like blocks
Note that this commit slightly increases size of boot blocks. Reviewed by: jhb Tested by: Olivier Cochard-Labbe <olivier@cochard.me> MFC after: 26 days
This commit is contained in:
parent
32321c3678
commit
7e87dba5cf
@ -415,8 +415,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) {
|
||||
|
@ -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);
|
||||
|
@ -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) */
|
||||
|
||||
|
@ -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 format reg
|
||||
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)
|
||||
|
@ -379,8 +379,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) {
|
||||
|
@ -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;
|
||||
|
||||
|
Loading…
x
Reference in New Issue
Block a user