RTOS/rtems
1
0
Fork 0
forked from Imagelibrary/rtems
Code Pull Requests Activity

2011-02-28 Sebastian Huber <sebastian.huber@embedded-brains.de>

Browse Source 
* console.c: Register also normal device file of the console device.
	Call initialization before the device file registration.
This commit is contained in:
Sebastian Huber
2011-02-28 15:11:48 +00:00
parent 11fe00d516
commit 8f8e9038bd
2 changed files with 30 additions and 57 deletions
Download Patch File Download Diff File Expand all files Collapse all files

5
c/src/lib/libbsp/shared/ChangeLog
View File

@@ -1,3 +1,8 @@
2011-02-28 Sebastian Huber <sebastian.huber@embedded-brains.de>
* console.c: Register also normal device file of the console device.
Call initialization before the device file registration.
2011-02-09 Ralf Corsépius <ralf.corsepius@rtems.org> 2011-02-09 Ralf Corsépius <ralf.corsepius@rtems.org>
* timerstub.c: Include <rtems/btimer.h>. * timerstub.c: Include <rtems/btimer.h>.

82
c/src/lib/libbsp/shared/console.c
View File

@@ -16,6 +16,7 @@
#include <bsp.h> #include <bsp.h>
#include <rtems/libio.h> #include <rtems/libio.h>
#include <rtems/console.h>
#include <stdlib.h> #include <stdlib.h>
#include <assert.h> #include <assert.h>
#include <termios.h> #include <termios.h>
@@ -216,77 +217,44 @@ rtems_device_driver console_control(
rtems_device_driver console_initialize( rtems_device_driver console_initialize(
rtems_device_major_number major, rtems_device_major_number major,
rtems_device_minor_number minor_arg, rtems_device_minor_number minor,
void *arg void *arg
) )
{ {
rtems_status_code status; rtems_status_code sc = RTEMS_SUCCESSFUL;
rtems_device_minor_number minor; bool first = true;
/*
* initialize the termio interface.
*/
rtems_termios_initialize(); rtems_termios_initialize();
for (minor=0; minor < Console_Port_Count ; minor++) { for (minor = 0; minor < Console_Port_Count; ++minor) {
/* const console_tbl *device = &Console_Port_Tbl [minor];
* First perform the configuration dependent probe, then the
* device dependent probe
*/
if ((!Console_Port_Tbl[minor].deviceProbe || if (
Console_Port_Tbl[minor].deviceProbe(minor)) && (device->deviceProbe == NULL || device->deviceProbe(minor))
Console_Port_Tbl[minor].pDeviceFns->deviceProbe(minor)) { && device->pDeviceFns->deviceProbe(minor)
/* ) {
* Use this device for the console device->pDeviceFns->deviceInitialize(minor);
*/ if (first) {
break; first = false;
Console_Port_Minor = minor;
sc = rtems_io_register_name(CONSOLE_DEVICE_NAME, major, minor);
if (sc != RTEMS_SUCCESSFUL) {
rtems_fatal_error_occurred(sc);
}
}
sc = rtems_io_register_name(device->sDeviceName, major, minor);
if (sc != RTEMS_SUCCESSFUL) {
rtems_fatal_error_occurred(sc);
}
} }
} }
if ( minor == Console_Port_Count ) {
if (first) {
/* /*
* Failed to find a working device * Failed to find a working device
*/ */
rtems_fatal_error_occurred(RTEMS_IO_ERROR); rtems_fatal_error_occurred(RTEMS_IO_ERROR);
} }
Console_Port_Minor=minor;
/*
* Register Device Names
*/
status = rtems_io_register_name("/dev/console", major, Console_Port_Minor );
if (status != RTEMS_SUCCESSFUL) {
rtems_fatal_error_occurred(status);
}
Console_Port_Tbl[minor].pDeviceFns->deviceInitialize(Console_Port_Minor);
for (minor++;minor<Console_Port_Count;minor++) {
/*
* First perform the configuration dependent probe, then the
* device dependent probe
*/
if ( (!Console_Port_Tbl[minor].deviceProbe ||
Console_Port_Tbl[minor].deviceProbe(minor)) &&
Console_Port_Tbl[minor].pDeviceFns->deviceProbe(minor)) {
status = rtems_io_register_name(
Console_Port_Tbl[minor].sDeviceName,
major,
minor );
if (status != RTEMS_SUCCESSFUL) {
rtems_fatal_error_occurred(status);
}
/*
* Initialize the hardware device.
*/
Console_Port_Tbl[minor].pDeviceFns->deviceInitialize(minor);
}
}
return RTEMS_SUCCESSFUL; return RTEMS_SUCCESSFUL;
} }