Subversion Repositories openrisc_me

/*

 * RTEMS monitor IO (device drivers) support

 *

 * There are 2 "driver" things the monitor knows about.

 *

 *    1. Regular RTEMS drivers.

 *         This is a table indexed by major device number and

 *         containing driver entry points only.

 *

 *    2. Driver name table.

 *         A separate table of names for drivers.

 *         The table converts driver names to a major number

 *         as index into the driver table and a minor number

 *         for an argument to driver.

 *

 *  Drivers are displayed with 'driver' command.

 *  Names are displayed with 'name' command.

 *

 *  $Id: mon-driver.c,v 1.2 2001-09-27 12:01:43 chris Exp $

 */

#define __RTEMS_VIOLATE_KERNEL_VISIBILITY__

#include <rtems.h>

#include <rtems/monitor.h>

#include <stdio.h>

#include <stdlib.h>             /* strtoul() */

#define DATACOL 15

#define CONTCOL DATACOL         /* continued col */

void

rtems_monitor_driver_canonical(

    rtems_monitor_driver_t *canonical_driver,

    void                   *driver_void

)

{

    rtems_driver_address_table *d = (rtems_driver_address_table *) driver_void;

    rtems_monitor_symbol_canonical_by_value(&canonical_driver->initialization,

                                            (void *) d->initialization);

    rtems_monitor_symbol_canonical_by_value(&canonical_driver->open,

                                            (void *) d->open);

    rtems_monitor_symbol_canonical_by_value(&canonical_driver->close,

                                            (void *) d->close);

    rtems_monitor_symbol_canonical_by_value(&canonical_driver->read,

                                            (void *) d->read);

    rtems_monitor_symbol_canonical_by_value(&canonical_driver->write,

                                            (void *) d->write);

    rtems_monitor_symbol_canonical_by_value(&canonical_driver->control,

                                            (void *) d->control);

}

void *

rtems_monitor_driver_next(

    void                  *object_info,

    rtems_monitor_driver_t *canonical_driver,

    rtems_id              *next_id

)

{

    rtems_configuration_table *c = _Configuration_Table;

    rtems_unsigned32 n = rtems_get_index(*next_id);

    if (n >= c->number_of_device_drivers)

        goto failed;

    _Thread_Disable_dispatch();

    /*

     * dummy up a fake id and name for this item

     */

    canonical_driver->id = n;

    canonical_driver->name = rtems_build_name('-', '-', '-', '-');

    *next_id += 1;

    return (void *) (c->Device_driver_table + n);

failed:

    *next_id = RTEMS_OBJECT_ID_FINAL;

    return 0;

}

void

rtems_monitor_driver_dump_header(

    boolean verbose

)

{

    printf("\

  Major      Entry points\n");

/*23456789 123456789 123456789 123456789 123456789 123456789 123456789 123456789

    rtems_monitor_separator();

}

void

rtems_monitor_driver_dump(

    rtems_monitor_driver_t *monitor_driver,

    boolean                 verbose

)

{

    unsigned32          length = 0;

    length += printf("  %d", monitor_driver->id);

    length += rtems_monitor_pad(13, length);

    length += printf("init: ");

    length += rtems_monitor_symbol_dump(&monitor_driver->initialization, verbose);

    length += printf(";  control: ");

    length += rtems_monitor_symbol_dump(&monitor_driver->control, verbose);

    length += printf("\n");

    length = 0;

    length += rtems_monitor_pad(13, length);

    length += printf("open: ");

    length += rtems_monitor_symbol_dump(&monitor_driver->open, verbose);

    length += printf(";  close: ");

    length += rtems_monitor_symbol_dump(&monitor_driver->close, verbose);

    length += printf("\n");

    length = 0;

    length += rtems_monitor_pad(13, length);

    length += printf("read: ");

    length += rtems_monitor_symbol_dump(&monitor_driver->read, verbose);

    length += printf(";  write: ");

    length += rtems_monitor_symbol_dump(&monitor_driver->write, verbose);

    length += printf("\n");

    length = 0;

}