diff options
author | Joel Sherrill <joel.sherrill@OARcorp.com> | 2007-05-29 19:56:35 +0000 |
---|---|---|
committer | Joel Sherrill <joel.sherrill@OARcorp.com> | 2007-05-29 19:56:35 +0000 |
commit | 9c556023f0d8d47bf5ce39a524e838936db7701f (patch) | |
tree | 9ef5118d3c1c69bd9ad651e681ffe16471b0ea14 /cpukit/sapi/src/ioregisterdriver.c | |
parent | 2007-05-29 Joel Sherrill <joel.sherrill@OARcorp.com> (diff) | |
download | rtems-9c556023f0d8d47bf5ce39a524e838936db7701f.tar.bz2 |
2007-05-29 Joel Sherrill <joel.sherrill@OARcorp.com>
* sapi/Makefile.am, sapi/include/rtems/io.h, sapi/src/io.c: Split into
one function per file execpt io.c which contains required
initialization methods.
* sapi/src/ioclose.c, sapi/src/iocontrol.c, sapi/src/iodata.c,
sapi/src/ioinitialize.c, sapi/src/ioopen.c, sapi/src/ioread.c,
sapi/src/ioregisterdriver.c, sapi/src/iounregisterdriver.c,
sapi/src/iowrite.c: New files.
Diffstat (limited to 'cpukit/sapi/src/ioregisterdriver.c')
-rw-r--r-- | cpukit/sapi/src/ioregisterdriver.c | 94 |
1 files changed, 94 insertions, 0 deletions
diff --git a/cpukit/sapi/src/ioregisterdriver.c b/cpukit/sapi/src/ioregisterdriver.c new file mode 100644 index 0000000000..45d5ffe97b --- /dev/null +++ b/cpukit/sapi/src/ioregisterdriver.c @@ -0,0 +1,94 @@ +/* + * Input/Output Manager - Dynamically Register Device Driver + * + * COPYRIGHT (c) 1989-2007. + * On-Line Applications Research Corporation (OAR). + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.com/license/LICENSE. + * + * $Id$ + */ + +#if HAVE_CONFIG_H +#include "config.h" +#endif + +#include <rtems/system.h> +#include <rtems/io.h> + +/* + * rtems_io_register_driver + * + * Register a driver into the device driver table. + * + * Input Paramters: + * major - device major number (0 means allocate + * a number) + * driver_table - driver callout function table + * registered_major - the major number which is registered + * + * Output Parameters: + * RTEMS_SUCCESSFUL - if successful + * error code - if unsuccessful + */ + +rtems_status_code rtems_io_register_driver( + rtems_device_major_number major, + rtems_driver_address_table *driver_table, + rtems_device_major_number *registered_major +) +{ + + /* + * Validate the pointer data and contents passed in + */ + if ( !driver_table ) + return RTEMS_INVALID_ADDRESS; + + if ( !registered_major ) + return RTEMS_INVALID_ADDRESS; + + if ( !driver_table->initialization_entry && !driver_table->open_entry ) + return RTEMS_INVALID_ADDRESS; + + *registered_major = 0; + + /* + * The requested major number is higher than what is configured. + */ + if ( major >= _IO_Number_of_drivers ) + return RTEMS_INVALID_NUMBER; + + /* + * Test for initialise/open being present to indicate the driver slot is + * in use. + */ + + if ( major == 0 ) { + boolean found = FALSE; + for ( major = _IO_Number_of_drivers - 1 ; major ; major-- ) { + if ( !_IO_Driver_address_table[major].initialization_entry && + !_IO_Driver_address_table[major].open_entry ) { + found = TRUE; + break; + } + } + + if ( !found ) + return RTEMS_TOO_MANY; + } + + if ( _IO_Driver_address_table[major].initialization_entry || + _IO_Driver_address_table[major].open_entry ) + return RTEMS_RESOURCE_IN_USE; + + + _IO_Driver_address_table[major] = *driver_table; + *registered_major = major; + + rtems_io_initialize( major, 0, NULL ); + + return RTEMS_SUCCESSFUL; +} |