1 files changed, 144 insertions, 0 deletions
diff --git a/cpukit/libmisc/monitor/mon-driver.c b/cpukit/libmisc/monitor/mon-driver.c
new file mode 100644
index 0000000000..c5c2c468b9
--- /dev/null
+++ b/cpukit/libmisc/monitor/mon-driver.c
@@ -0,0 +1,144 @@
+/*
+ * 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$
+ */
+
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#define __RTEMS_VIOLATE_KERNEL_VISIBILITY__
+#include <rtems.h>
+
+#include <rtems/monitor.h>
+
+#include <stdio.h>
+#include <stdlib.h>             /* strtoul() */
+#include <inttypes.h>
+
+#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_entry);
+
+    rtems_monitor_symbol_canonical_by_value(&canonical_driver->open,
+                                            (void *) d->open_entry);
+    rtems_monitor_symbol_canonical_by_value(&canonical_driver->close,
+                                            (void *) d->close_entry);
+    rtems_monitor_symbol_canonical_by_value(&canonical_driver->read,
+                                            (void *) d->read_entry);
+    rtems_monitor_symbol_canonical_by_value(&canonical_driver->write,
+                                            (void *) d->write_entry);
+    rtems_monitor_symbol_canonical_by_value(&canonical_driver->control,
+                                            (void *) d->control_entry);
+}
+
+
+void *
+rtems_monitor_driver_next(
+    void                  *object_info __attribute__((unused)),
+    rtems_monitor_driver_t *canonical_driver,
+    rtems_id              *next_id
+)
+{
+    rtems_configuration_table *c = &Configuration;
+    uint32_t   n = rtems_object_id_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(
+    bool verbose __attribute__((unused))
+)
+{
+    fprintf(stdout,"\
+  Major      Entry points\n");
+/*23456789 123456789 123456789 123456789 123456789 123456789 123456789 123456789
+0         1         2         3         4         5         6         7       */
+    rtems_monitor_separator();
+}
+
+void
+rtems_monitor_driver_dump(
+    rtems_monitor_driver_t *monitor_driver,
+    bool                    verbose
+)
+{
+    uint32_t            length = 0;
+
+#if defined(RTEMS_USE_16_BIT_OBJECT)
+    length += fprintf(stdout,"  %" PRId16 "", monitor_driver->id);
+#else
+    length += fprintf(stdout,"  %" PRId32 "", monitor_driver->id);
+#endif
+    length += rtems_monitor_pad(13, length);
+    length += fprintf(stdout,"init: ");
+    length += rtems_monitor_symbol_dump(&monitor_driver->initialization, verbose);
+    length += fprintf(stdout,";  control: ");
+    length += rtems_monitor_symbol_dump(&monitor_driver->control, verbose);
+    length += fprintf(stdout,"\n");
+    length = 0;
+
+    length += rtems_monitor_pad(13, length);
+
+    length += fprintf(stdout,"open: ");
+    length += rtems_monitor_symbol_dump(&monitor_driver->open, verbose);
+    length += fprintf(stdout,";  close: ");
+    length += rtems_monitor_symbol_dump(&monitor_driver->close, verbose);
+    length += fprintf(stdout,"\n");
+    length = 0;
+
+    length += rtems_monitor_pad(13, length);
+
+    length += fprintf(stdout,"read: ");
+    length += rtems_monitor_symbol_dump(&monitor_driver->read, verbose);
+    length += fprintf(stdout,";  write: ");
+    length += rtems_monitor_symbol_dump(&monitor_driver->write, verbose);
+    length += fprintf(stdout,"\n");
+    length = 0;
+}