Subversion Repositories or1k

/*

 * RTEMS monitor main body

 *

 *  TODO:

 *      add stuff to RTEMS api

 *            rtems_get_name(id)

 *            rtems_get_type(id)

 *            rtems_build_id(node, type, num)

 *      Add a command to dump out info about an arbitrary id when

 *         types are added to id's

 *         rtems> id idnum

 *                idnum: node n, object: whatever, id: whatever

 *      allow id's to be specified as n:t:id, where 'n:t' is optional

 *      should have a separate monitor FILE stream (ala the debugger)

 *      remote request/response stuff should be cleaned up

 *         maybe we can use real rpc??

 *      'info' command to print out:

 *           interrupt stack location, direction and size

 *           floating point config stuff

 *           interrupt config stuff

 *

 *  mon-monitor.c,v 1.14 2002/07/01 22:19:33 joel Exp

 */

#include <rtems.h>

#include <stdio.h>

#include <string.h>

#include <stdlib.h>

#include <termios.h>

#include <unistd.h>

#include <rtems/monitor.h>

/* set by trap handler */

extern rtems_tcb       *debugger_interrupted_task;

extern rtems_context   *debugger_interrupted_task_context;

extern rtems_unsigned32 debugger_trap;

/*

 * Various id's for the monitor

 * They need to be public variables for access by other agencies

 * such as debugger and remote servers'

 */

rtems_id  rtems_monitor_task_id;

unsigned32 rtems_monitor_node;          /* our node number */

unsigned32 rtems_monitor_default_node;  /* current default for commands */

/*

 * The rtems symbol table

 */

rtems_symbol_table_t *rtems_monitor_symbols;

/*

 * User registered commands.

 */

rtems_monitor_command_entry_t rtems_registered_commands;

/*

 * The top-level commands

 */

rtems_monitor_command_entry_t rtems_monitor_commands[] = {

    { "config",

      "Show the system configuration.",

      0,

      rtems_monitor_object_cmd,

      (rtems_monitor_command_arg_t) RTEMS_MONITOR_OBJECT_CONFIG,

      &rtems_monitor_commands[1],

    },

    { "itask",

      "List init tasks for the system",

      0,

      rtems_monitor_object_cmd,

      (rtems_monitor_command_arg_t) RTEMS_MONITOR_OBJECT_INIT_TASK,

      &rtems_monitor_commands[2],

    },

   { "mpci",

      "Show the MPCI system configuration, if configured.",

      0,

      rtems_monitor_object_cmd,

      (rtems_monitor_command_arg_t) RTEMS_MONITOR_OBJECT_MPCI,

      &rtems_monitor_commands[3],

    },

    { "pause",

      "Monitor goes to \"sleep\" for specified ticks (default is 1). "

      "Monitor will resume at end of period or if explicitly awakened\n"

      "  pause [ticks]",

      0,

      rtems_monitor_pause_cmd,

      0,

      &rtems_monitor_commands[4],

    },

    { "continue",

      "Put the monitor to sleep waiting for an explicit wakeup from the "

      "program running.\n",

      0,

      rtems_monitor_continue_cmd,

      0,

      &rtems_monitor_commands[5],

    },

    { "go",

      "Alias for 'continue'",

      0,

      rtems_monitor_continue_cmd,

      0,

      &rtems_monitor_commands[6],

    },

    { "node",

      "Specify default node number for commands that take id's.\n"

      "  node [ node number ]",

      0,

      rtems_monitor_node_cmd,

      0,

      &rtems_monitor_commands[7],

    },

    { "symbol",

      "Display value associated with specified symbol. "

      "Defaults to displaying all known symbols.\n"

      "  symbol [ symbolname [symbolname ... ] ]",

      0,

      rtems_monitor_symbol_cmd,

#if defined(RTEMS_CPU_HAS_16_BIT_ADDRESSES)

      0,    /* XXX find a way to fix the compile time error on h8 */

#else

      (rtems_monitor_command_arg_t) &rtems_monitor_symbols,

#endif

      &rtems_monitor_commands[8],

    },

    { "extension",

      "Display information about specified extensions. "

      "Default is to display information about all extensions on this node.\n"

      "  extension [id [id ...] ]",

      0,

      rtems_monitor_object_cmd,

      (rtems_monitor_command_arg_t) RTEMS_MONITOR_OBJECT_EXTENSION,

      &rtems_monitor_commands[9],

    },

    { "task",

      "Display information about the specified tasks. "

      "Default is to display information about all tasks on this node.\n"

      "  task [id [id ...] ]",

      0,

      rtems_monitor_object_cmd,

      (rtems_monitor_command_arg_t) RTEMS_MONITOR_OBJECT_TASK,

      &rtems_monitor_commands[10],

    },

    { "queue",

      "Display information about the specified message queues. "

      "Default is to display information about all queues on this node.\n"

      "  queue [id [id ... ] ]",

      0,

      rtems_monitor_object_cmd,

      (rtems_monitor_command_arg_t) RTEMS_MONITOR_OBJECT_QUEUE,

      &rtems_monitor_commands[11],

    },

    { "object",

      "Display information about specified RTEMS objects. "

      "Object id's must include 'type' information. "

      "(which may normally be defaulted)\n"

      "  object [id [id ...] ]",

      0,

      rtems_monitor_object_cmd,

      (rtems_monitor_command_arg_t) RTEMS_MONITOR_OBJECT_INVALID,

      &rtems_monitor_commands[12],

    },

    { "driver",

      "Display the RTEMS device driver table.\n"

      "  driver [ major [ major ... ] ]",

      0,

      rtems_monitor_object_cmd,

      (rtems_monitor_command_arg_t) RTEMS_MONITOR_OBJECT_DRIVER,

      &rtems_monitor_commands[13],

    },

    { "dname",

      "Displays information about named drivers.\n",

      0,

      rtems_monitor_object_cmd,

      (rtems_monitor_command_arg_t) RTEMS_MONITOR_OBJECT_DNAME,

      &rtems_monitor_commands[14],

    },

    { "exit",

      "Invoke 'rtems_fatal_error_occurred' with 'status' "

      "(default is RTEMS_SUCCESSFUL)\n"

      "  exit [status]",

      0,

      rtems_monitor_fatal_cmd,

      (rtems_monitor_command_arg_t) RTEMS_SUCCESSFUL,

      &rtems_monitor_commands[15],

    },

    { "fatal",

      "'exit' with fatal error; default error is RTEMS_TASK_EXITTED\n"

      "  fatal [status]",

      0,

      rtems_monitor_fatal_cmd,

      (rtems_monitor_command_arg_t) RTEMS_TASK_EXITTED,         /* exit value */

      &rtems_monitor_commands[16],

    },

    { "quit",

      "Alias for 'exit'\n",

      0,

      rtems_monitor_fatal_cmd,

      (rtems_monitor_command_arg_t) RTEMS_SUCCESSFUL,                           /* exit value */

      &rtems_monitor_commands[17],

    },

    { "help",

      "Provide information about commands. "

      "Default is show basic command summary.\n"

      "help [ command [ command ] ]",

      0,

      rtems_monitor_help_cmd,

#if defined(RTEMS_CPU_HAS_16_BIT_ADDRESSES)

      0,    /* XXX find a way to fix the compile time error on h8 */

#else

      (rtems_monitor_command_arg_t) rtems_monitor_commands,

#endif

      &rtems_monitor_commands[18],

    },

#ifdef CPU_INVOKE_DEBUGGER

    { "debugger",

      "Enter the debugger, if possible. "

      "A continue from the debugger will return to the monitor.\n",

      0,

      rtems_monitor_debugger_cmd,

      0,

      &rtems_monitor_commands[19],

    },

#endif            

    { 0, 0, 0, 0, 0, &rtems_registered_commands },

};

rtems_status_code

rtems_monitor_suspend(rtems_interval timeout)

{

    rtems_event_set event_set;

    rtems_status_code status;

    status = rtems_event_receive(MONITOR_WAKEUP_EVENT,

                                 RTEMS_DEFAULT_OPTIONS,

                                 timeout,

                                 &event_set);

    return status;

}

void

rtems_monitor_wakeup(void)

{

    rtems_status_code status;

    status = rtems_event_send(rtems_monitor_task_id, MONITOR_WAKEUP_EVENT);

}

void

rtems_monitor_debugger_cmd(

    int        argc,

    char     **argv,

    unsigned32 command_arg,

    boolean    verbose

)

{

#ifdef CPU_INVOKE_DEBUGGER

    CPU_INVOKE_DEBUGGER;

#endif

}

void

rtems_monitor_pause_cmd(

    int        argc,

    char     **argv,

    unsigned32 command_arg,

    boolean    verbose

)

{

    if (argc == 1)

        rtems_monitor_suspend(1);

    else

        rtems_monitor_suspend(strtoul(argv[1], 0, 0));

}

void

rtems_monitor_fatal_cmd(

    int     argc,

    char  **argv,

    unsigned32 command_arg,

    boolean verbose

)

{

    if (argc == 1)

        rtems_fatal_error_occurred(command_arg);

    else

        rtems_fatal_error_occurred(strtoul(argv[1], 0, 0));

}

void

rtems_monitor_continue_cmd(

    int     argc,

    char  **argv,

    unsigned32 command_arg,

    boolean verbose

)

{

    rtems_monitor_suspend(RTEMS_NO_TIMEOUT);

}

void

rtems_monitor_node_cmd(

    int     argc,

    char  **argv,

    unsigned32 command_arg,

    boolean verbose

)

{

    unsigned32 new_node = rtems_monitor_default_node;

    switch (argc)

    {

        case 1:                 /* no node, just set back to ours */

            new_node = rtems_monitor_node;

            break;

        case 2:

            new_node = strtoul(argv[1], 0, 0);

            break;

        default:

            printf("invalid syntax, try 'help node'\n");

            break;

    }

    if ((new_node >= 1) &&

        _Configuration_MP_table &&

        (new_node <= _Configuration_MP_table->maximum_nodes))

            rtems_monitor_default_node = new_node;

}

/*

 *  Function:   rtems_monitor_symbols_loadup

 *

 *  Description:

 *      Create and load the monitor's symbol table.

 *      We are reading the output format of 'gnm' which looks like this:

 *

 *              400a7068 ? _Rate_monotonic_Information

 *              400a708c ? _Thread_Dispatch_disable_level

 *              400a7090 ? _Configuration_Table

 *

 *      We ignore the type field.

 *

 *  Side Effects:

 *      Creates and fills in 'rtems_monitor_symbols' table

 *

 *  TODO

 *      there should be a BSP #define or something like that

 *         to do this;  Assuming stdio is crazy.

 *      Someday this should know BFD

 *              Maybe we could get objcopy to just copy the symbol areas

 *              and copy that down.

 *

 */

void

rtems_monitor_symbols_loadup(void)

{

    FILE *fp;

    char buffer[128];

    if (rtems_monitor_symbols)

        rtems_symbol_table_destroy(rtems_monitor_symbols);

    rtems_monitor_symbols = rtems_symbol_table_create(10);

    if (rtems_monitor_symbols == 0)

        return;

    fp = fopen("symbols", "r");

    if (fp == 0)

        return;

    while (fgets(buffer, sizeof(buffer) - 1, fp))

    {

        char *symbol;

        char *value;

        char *ignored_type;

        value = strtok(buffer, " \t\n");

        ignored_type = strtok(0, " \t\n");

        symbol = strtok(0, " \t\n");

        if (symbol && ignored_type && value)

        {

            rtems_symbol_t *sp;

            sp = rtems_symbol_create(rtems_monitor_symbols,

                                     symbol,

                                     (rtems_unsigned32) strtoul(value, 0, 16));

            if (sp == 0)

            {

                printf("could not define symbol '%s'\n", symbol);

                goto done;

            }

        }

        else

        {

            printf("parsing error on '%s'\n", buffer);

            goto done;

        }

    }

done:

    return;

}

/*

 * User registered commands.

 */

int

rtems_monitor_insert_cmd (

    rtems_monitor_command_entry_t *command

)

{

    rtems_monitor_command_entry_t *p = rtems_registered_commands.next;

    command->next = 0;

    if (rtems_registered_commands.next)

    {

        for (; p->next; p = p->next)

        {

            if (STREQ(command->command, p->command))

                return 0;

        }

        p->next = command;

    }

    else

        rtems_registered_commands.next = command;

    return 1;

}

int

rtems_monitor_erase_cmd (

    rtems_monitor_command_entry_t *command

)

{

    rtems_monitor_command_entry_t *p;

    rtems_monitor_command_entry_t **p_prev = &rtems_registered_commands.next;

    if (rtems_registered_commands.next)

    {

        for (p = rtems_registered_commands.next; p->next; p = p->next)

        {

            if (STREQ(command->command, p->command))

            {

                *p_prev = p->next;

                return 1;

            }

            p_prev = &p->next;

        }

    }

    return 0;

}

/*

 * Main monitor command loop

 */

void

rtems_monitor_task(

    rtems_task_argument monitor_flags

)

{

    rtems_tcb *debugee = 0;

    rtems_context *rp;

    rtems_context_fp *fp;

    char command_buffer[513];

    int argc;

    char *argv[64];

    boolean verbose = FALSE;

    struct termios term;

    /*

     * Make the stdin stream characte not line based.

     */

    if (tcgetattr (STDIN_FILENO, &term) < 0)

    {

      printf("rtems-monitor: cannot get terminal attributes.\n");

    }

    else

    {

      /*

       * No echo, no canonical processing.

       */

      term.c_lflag &= ~(ECHO | ICANON | IEXTEN);

      /*

       * No sigint on BREAK, CR-to-NL off, input parity off,

       * don't strip 8th bit on input, output flow control off

       */

      term.c_lflag    &= ~(INPCK | ISTRIP | IXON);

      term.c_cc[VMIN]  = 1;

      term.c_cc[VTIME] = 0;

      if (tcsetattr (STDIN_FILENO, TCSANOW, &term) < 0)

      {

        printf("cannot set terminal attributes\n");

      }

    }

    if (monitor_flags & RTEMS_MONITOR_SUSPEND)

        (void) rtems_monitor_suspend(RTEMS_NO_TIMEOUT);

    for (;;)

    {

        extern rtems_tcb * _Thread_Executing;

        rtems_monitor_command_entry_t *command;

        debugee = _Thread_Executing;

        rp = &debugee->Registers;

#if (CPU_HARDWARE_FP == TRUE) || (CPU_SOFTWARE_FP == TRUE)

        fp = (rtems_context_fp *) debugee->fp_context;  /* possibly 0 */

#else

        fp = 0;

#endif

        if (0 == rtems_monitor_command_read(command_buffer, &argc, argv))

            continue;

        if ((command = rtems_monitor_command_lookup(rtems_monitor_commands,

                                                    argc,

                                                    argv)) == 0)

        {

            /* no command */

            printf("Unrecognised command; try 'help'\n");

            continue;

        }

        command->command_function(argc, argv, command->command_arg, verbose);

        fflush(stdout);

    }

}

void

rtems_monitor_kill(void)

{

    if (rtems_monitor_task_id)

        rtems_task_delete(rtems_monitor_task_id);

    rtems_monitor_task_id = 0;

    rtems_monitor_server_kill();

}

void

rtems_monitor_init(

    unsigned32 monitor_flags

)

{

    rtems_status_code status;

    rtems_monitor_kill();

    status = rtems_task_create(RTEMS_MONITOR_NAME,

                               1,

                               RTEMS_MINIMUM_STACK_SIZE * 2,

                               RTEMS_INTERRUPT_LEVEL(0),

                               RTEMS_DEFAULT_ATTRIBUTES,

                               &rtems_monitor_task_id);

    if (status != RTEMS_SUCCESSFUL)

    {

        rtems_error(status, "could not create monitor task");

        return;

    }

    rtems_monitor_node = rtems_get_node(rtems_monitor_task_id);

    rtems_monitor_default_node = rtems_monitor_node;

    rtems_monitor_symbols_loadup();

    if (monitor_flags & RTEMS_MONITOR_GLOBAL)

        rtems_monitor_server_init(monitor_flags);

    /*

     * Start the monitor task itself

     */

    status = rtems_task_start(rtems_monitor_task_id,

                              rtems_monitor_task,

                              monitor_flags);

    if (status != RTEMS_SUCCESSFUL)

    {

        rtems_error(status, "could not start monitor");

        return;

    }

}