forked from Imagelibrary/rtems
2008-05-22 Joel Sherrill <joel.sherrill@oarcorp.com>
* shared/console/console.c: Remove explicit switch and call termios_baud_to_number().
This commit is contained in:
@@ -1,3 +1,8 @@
|
|||||||
|
2008-05-22 Joel Sherrill <joel.sherrill@oarcorp.com>
|
||||||
|
|
||||||
|
* shared/console/console.c: Remove explicit switch and call
|
||||||
|
termios_baud_to_number().
|
||||||
|
|
||||||
2008-05-15 Joel Sherrill <joel.sherrill@OARcorp.com>
|
2008-05-15 Joel Sherrill <joel.sherrill@OARcorp.com>
|
||||||
|
|
||||||
* shared/startup/pretaskinghook.c: Add capability for bootcard.c BSP
|
* shared/startup/pretaskinghook.c: Add capability for bootcard.c BSP
|
||||||
|
|||||||
@@ -98,10 +98,11 @@ static TtySTblRec ttyS[]={
|
|||||||
+--------------------------------------------------------------------------+
|
+--------------------------------------------------------------------------+
|
||||||
| Initilizes the I/O console (keyboard + VGA display) driver.
|
| Initilizes the I/O console (keyboard + VGA display) driver.
|
||||||
+--------------------------------------------------------------------------*/
|
+--------------------------------------------------------------------------*/
|
||||||
rtems_device_driver
|
rtems_device_driver console_initialize(
|
||||||
console_initialize(rtems_device_major_number major,
|
rtems_device_major_number major,
|
||||||
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
||||||
void *arg)
|
void *arg
|
||||||
|
)
|
||||||
{
|
{
|
||||||
rtems_status_code status;
|
rtems_status_code status;
|
||||||
|
|
||||||
@@ -134,19 +135,15 @@ console_initialize(rtems_device_major_number major,
|
|||||||
* Register the device
|
* Register the device
|
||||||
*/
|
*/
|
||||||
status = rtems_io_register_name ((nm=ttyS[minor].name), major, minor);
|
status = rtems_io_register_name ((nm=ttyS[minor].name), major, minor);
|
||||||
if ( RTEMS_SUCCESSFUL==status && BSPConsolePort == minor)
|
if ( RTEMS_SUCCESSFUL==status && BSPConsolePort == minor) {
|
||||||
{
|
|
||||||
printk("Registering /dev/console as minor %d (==%s)\n",
|
printk("Registering /dev/console as minor %d (==%s)\n",
|
||||||
minor,
|
minor,
|
||||||
ttyS[minor].name);
|
ttyS[minor].name);
|
||||||
/* also register an alias */
|
/* also register an alias */
|
||||||
status = rtems_io_register_name (
|
status = rtems_io_register_name ( (nm="/dev/console"), major, minor);
|
||||||
(nm="/dev/console"),
|
|
||||||
major,
|
|
||||||
minor);
|
|
||||||
}
|
}
|
||||||
if (status != RTEMS_SUCCESSFUL)
|
|
||||||
{
|
if (status != RTEMS_SUCCESSFUL) {
|
||||||
printk("Error registering %s!\n",nm);
|
printk("Error registering %s!\n",nm);
|
||||||
rtems_fatal_error_occurred (status);
|
rtems_fatal_error_occurred (status);
|
||||||
}
|
}
|
||||||
@@ -165,8 +162,7 @@ static int console_first_open(int major, int minor, void *arg)
|
|||||||
/* 9600-8-N-1 */
|
/* 9600-8-N-1 */
|
||||||
BSP_uart_init(minor, 9600, 0);
|
BSP_uart_init(minor, 9600, 0);
|
||||||
status = BSP_uart_install_isr(minor, ttyS[minor].isr);
|
status = BSP_uart_install_isr(minor, ttyS[minor].isr);
|
||||||
if (!status)
|
if (!status) {
|
||||||
{
|
|
||||||
printk("Error installing serial console interrupt handler for '%s'!\n",
|
printk("Error installing serial console interrupt handler for '%s'!\n",
|
||||||
ttyS[minor].name);
|
ttyS[minor].name);
|
||||||
rtems_fatal_error_occurred(status);
|
rtems_fatal_error_occurred(status);
|
||||||
@@ -183,10 +179,11 @@ static int console_last_close(int major, int minor, void *arg)
|
|||||||
/*-------------------------------------------------------------------------+
|
/*-------------------------------------------------------------------------+
|
||||||
| Console device driver OPEN entry point
|
| Console device driver OPEN entry point
|
||||||
+--------------------------------------------------------------------------*/
|
+--------------------------------------------------------------------------*/
|
||||||
rtems_device_driver
|
rtems_device_driver console_open(
|
||||||
console_open(rtems_device_major_number major,
|
rtems_device_major_number major,
|
||||||
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
||||||
void *arg)
|
void *arg
|
||||||
|
)
|
||||||
{
|
{
|
||||||
rtems_status_code status;
|
rtems_status_code status;
|
||||||
static rtems_termios_callbacks cb =
|
static rtems_termios_callbacks cb =
|
||||||
@@ -220,8 +217,7 @@ console_open(rtems_device_major_number major,
|
|||||||
|
|
||||||
status = rtems_termios_open (major, minor, arg, &cb);
|
status = rtems_termios_open (major, minor, arg, &cb);
|
||||||
|
|
||||||
if(status != RTEMS_SUCCESSFUL)
|
if (status != RTEMS_SUCCESSFUL) {
|
||||||
{
|
|
||||||
printk("Error opening console device\n");
|
printk("Error opening console device\n");
|
||||||
return status;
|
return status;
|
||||||
}
|
}
|
||||||
@@ -241,9 +237,11 @@ console_open(rtems_device_major_number major,
|
|||||||
| Console device driver CLOSE entry point
|
| Console device driver CLOSE entry point
|
||||||
+--------------------------------------------------------------------------*/
|
+--------------------------------------------------------------------------*/
|
||||||
rtems_device_driver
|
rtems_device_driver
|
||||||
console_close(rtems_device_major_number major,
|
console_close(
|
||||||
|
rtems_device_major_number major,
|
||||||
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
||||||
void *arg)
|
void *arg
|
||||||
|
)
|
||||||
{
|
{
|
||||||
rtems_device_driver res = RTEMS_SUCCESSFUL;
|
rtems_device_driver res = RTEMS_SUCCESSFUL;
|
||||||
|
|
||||||
@@ -257,12 +255,12 @@ console_close(rtems_device_major_number major,
|
|||||||
+--------------------------------------------------------------------------+
|
+--------------------------------------------------------------------------+
|
||||||
| Read characters from the I/O console. We only have stdin.
|
| Read characters from the I/O console. We only have stdin.
|
||||||
+--------------------------------------------------------------------------*/
|
+--------------------------------------------------------------------------*/
|
||||||
rtems_device_driver
|
rtems_device_driver console_read(
|
||||||
console_read(rtems_device_major_number major,
|
rtems_device_major_number major,
|
||||||
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
||||||
void *arg)
|
void *arg
|
||||||
|
)
|
||||||
{
|
{
|
||||||
|
|
||||||
return rtems_termios_read (arg);
|
return rtems_termios_read (arg);
|
||||||
} /* console_read */
|
} /* console_read */
|
||||||
|
|
||||||
@@ -271,104 +269,47 @@ console_read(rtems_device_major_number major,
|
|||||||
+--------------------------------------------------------------------------+
|
+--------------------------------------------------------------------------+
|
||||||
| Write characters to the I/O console. Stderr and stdout are the same.
|
| Write characters to the I/O console. Stderr and stdout are the same.
|
||||||
+--------------------------------------------------------------------------*/
|
+--------------------------------------------------------------------------*/
|
||||||
rtems_device_driver
|
rtems_device_driver console_write(
|
||||||
console_write(rtems_device_major_number major,
|
rtems_device_major_number major,
|
||||||
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
||||||
void * arg)
|
void *arg
|
||||||
|
)
|
||||||
{
|
{
|
||||||
|
|
||||||
return rtems_termios_write (arg);
|
return rtems_termios_write (arg);
|
||||||
|
|
||||||
} /* console_write */
|
} /* console_write */
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Handle ioctl request.
|
* Handle ioctl request.
|
||||||
*/
|
*/
|
||||||
rtems_device_driver
|
rtems_device_driver console_control(
|
||||||
console_control(rtems_device_major_number major,
|
rtems_device_major_number major,
|
||||||
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
||||||
void *arg
|
void *arg
|
||||||
)
|
)
|
||||||
|
)
|
||||||
{
|
{
|
||||||
/* does the BSP support break callbacks ? */
|
/* does the BSP support break callbacks ? */
|
||||||
#if defined(BIOCSETBREAKCB) && defined(BIOCGETBREAKCB)
|
#if defined(BIOCSETBREAKCB) && defined(BIOCGETBREAKCB)
|
||||||
rtems_libio_ioctl_args_t *ioa=arg;
|
rtems_libio_ioctl_args_t *ioa=arg;
|
||||||
switch (ioa->command) {
|
switch (ioa->command) {
|
||||||
case BIOCSETBREAKCB:
|
case BIOCSETBREAKCB: return BSP_uart_set_break_cb(minor, ioa);
|
||||||
return BSP_uart_set_break_cb(minor, ioa);
|
case BIOCGETBREAKCB: return BSP_uart_get_break_cb(minor, ioa);
|
||||||
case BIOCGETBREAKCB:
|
default: break;
|
||||||
return BSP_uart_get_break_cb(minor, ioa);
|
|
||||||
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
return rtems_termios_ioctl (arg);
|
return rtems_termios_ioctl (arg);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int
|
static int conSetAttr(
|
||||||
conSetAttr(int minor, const struct termios *t)
|
int minor,
|
||||||
|
const struct termios *t
|
||||||
|
)
|
||||||
{
|
{
|
||||||
int baud;
|
int baud;
|
||||||
|
|
||||||
switch (t->c_cflag & CBAUD)
|
baud = termios_baud_to_number(t->c_cflag & CBAUD);
|
||||||
{
|
if ( baud > 115200 )
|
||||||
case B50:
|
|
||||||
baud = 50;
|
|
||||||
break;
|
|
||||||
case B75:
|
|
||||||
baud = 75;
|
|
||||||
break;
|
|
||||||
case B110:
|
|
||||||
baud = 110;
|
|
||||||
break;
|
|
||||||
case B134:
|
|
||||||
baud = 134;
|
|
||||||
break;
|
|
||||||
case B150:
|
|
||||||
baud = 150;
|
|
||||||
break;
|
|
||||||
case B200:
|
|
||||||
baud = 200;
|
|
||||||
break;
|
|
||||||
case B300:
|
|
||||||
baud = 300;
|
|
||||||
break;
|
|
||||||
case B600:
|
|
||||||
baud = 600;
|
|
||||||
break;
|
|
||||||
case B1200:
|
|
||||||
baud = 1200;
|
|
||||||
break;
|
|
||||||
case B1800:
|
|
||||||
baud = 1800;
|
|
||||||
break;
|
|
||||||
case B2400:
|
|
||||||
baud = 2400;
|
|
||||||
break;
|
|
||||||
case B4800:
|
|
||||||
baud = 4800;
|
|
||||||
break;
|
|
||||||
case B9600:
|
|
||||||
baud = 9600;
|
|
||||||
break;
|
|
||||||
case B19200:
|
|
||||||
baud = 19200;
|
|
||||||
break;
|
|
||||||
case B38400:
|
|
||||||
baud = 38400;
|
|
||||||
break;
|
|
||||||
case B57600:
|
|
||||||
baud = 57600;
|
|
||||||
break;
|
|
||||||
case B115200:
|
|
||||||
baud = 115200;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
baud = 0;
|
|
||||||
rtems_fatal_error_occurred (RTEMS_INTERNAL_ERROR);
|
rtems_fatal_error_occurred (RTEMS_INTERNAL_ERROR);
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
BSP_uart_set_baud(minor, baud);
|
BSP_uart_set_baud(minor, baud);
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user