WebSVN – HelenOS-historic – Diff – /kernel/trunk/generic/src/console/kconsole.c


/*
 * Copyright (C) 2005 Jakub Jermar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
#include <console/kconsole.h>
#include <console/console.h>
#include <console/chardev.h>
#include <print.h>
#include <panic.h>
#include <typedefs.h>
#include <arch/types.h>
#include <list.h>
#include <arch.h>
#include <func.h>
#include <macros.h>
#include <debug.h>
#include <symtab.h>
 
#include <mm/tlb_cmd.h>
 
#define MAX_CMDLINE 256
 
/** Simple kernel console.
 *
 * The console is realized by kernel thread kconsole.
 * It doesn't understand any useful command on its own,
 * but makes it possible for other kernel subsystems to
 * register their own commands.
 */
 
/** Locking.
 *
 * There is a list of cmd_info_t structures. This list
 * is protected by cmd_lock spinlock. Note that specially
 * the link elements of cmd_info_t are protected by
 * this lock.
 *
 * Each cmd_info_t also has its own lock, which protects
 * all elements thereof except the link element.
 *
 * cmd_lock must be acquired before any cmd_info lock.
 * When locking two cmd info structures, structure with
 * lower address must be locked first.
 */
 
spinlock_t cmd_lock;    /**< Lock protecting command list. */
link_t cmd_head;    /**< Command list. */
 
static cmd_info_t *parse_cmdline(char *cmdline, size_t len);
static bool parse_argument(char *cmdline, size_t len, index_t *start, index_t *end);
 
/** Data and methods for 'help' command. */
static int cmd_help(cmd_arg_t *argv);
static cmd_info_t help_info = {
    .name = "help",
    .description = "List of supported commands.",
    .func = cmd_help,
    .argc = 0
};
 
/** Data and methods for 'description' command. */
static int cmd_desc(cmd_arg_t *argv);
static void desc_help(void);
static char desc_buf[MAX_CMDLINE+1];
static cmd_arg_t desc_argv = {
    .type = ARG_TYPE_STRING,
    .buffer = desc_buf,
    .len = sizeof(desc_buf)
};
static cmd_info_t desc_info = {
    .name = "describe",
    .description = "Describe specified command.",
    .help = desc_help,
    .func = cmd_desc,
    .argc = 1,
    .argv = &desc_argv
};
 
/** Data and methods for 'symaddr' command. */
static int cmd_symaddr(cmd_arg_t *argv);
static char symaddr_buf[MAX_CMDLINE+1];
static cmd_arg_t symaddr_argv = {
    .type = ARG_TYPE_STRING,
    .buffer = symaddr_buf,
    .len = sizeof(symaddr_buf)
};
static cmd_info_t symaddr_info = {
    .name = "symaddr",
    .description = "Return symbol address.",
    .func = cmd_symaddr,
    .argc = 1,
    .argv = &symaddr_argv
};
 
/** Call0 - call function with no parameters */
static char call0_buf[MAX_CMDLINE+1];
static char carg1_buf[MAX_CMDLINE+1];
static char carg2_buf[MAX_CMDLINE+1];
static char carg3_buf[MAX_CMDLINE+1];
 
static int cmd_call0(cmd_arg_t *argv);
static cmd_arg_t call0_argv = {
    .type = ARG_TYPE_STRING,
    .buffer = call0_buf,
    .len = sizeof(call0_buf)
};
static cmd_info_t call0_info = {
    .name = "call0",
    .description = "call0 <function> -> call function().",
    .func = cmd_call0,
    .argc = 1,
    .argv = &call0_argv
};
 
static int cmd_call1(cmd_arg_t *argv);
static cmd_arg_t call1_argv[] = {
    {
        .type = ARG_TYPE_STRING,
        .buffer = call0_buf,
        .len = sizeof(call0_buf)
    },
    {
        .type = ARG_TYPE_VAR,
        .buffer = carg1_buf,
        .len = sizeof(carg1_buf)
    }
};
static cmd_info_t call1_info = {
    .name = "call1",
    .description = "call1 <function> <arg1> -> call function(arg1).",
    .func = cmd_call1,
    .argc = 2,
    .argv = call1_argv
};
 
static int cmd_call2(cmd_arg_t *argv);
static cmd_arg_t call2_argv[] = {
    {
        .type = ARG_TYPE_STRING,
        .buffer = call0_buf,
        .len = sizeof(call0_buf)
    },
    {
        .type = ARG_TYPE_VAR,
        .buffer = carg1_buf,
        .len = sizeof(carg1_buf)
    },
    {
        .type = ARG_TYPE_VAR,
        .buffer = carg2_buf,
        .len = sizeof(carg2_buf)
    }
};
static cmd_info_t call2_info = {
    .name = "call2",
    .description = "call2 <function> <arg1> <arg2> -> call function(arg1,arg2).",
    .func = cmd_call2,
    .argc = 3,
    .argv = call2_argv
};
 
static int cmd_call3(cmd_arg_t *argv);
static cmd_arg_t call3_argv[] = {
    {
        .type = ARG_TYPE_STRING,
        .buffer = call0_buf,
        .len = sizeof(call0_buf)
    },
    {
        .type = ARG_TYPE_VAR,
        .buffer = carg1_buf,
        .len = sizeof(carg1_buf)
    },
    {
        .type = ARG_TYPE_VAR,
        .buffer = carg2_buf,
        .len = sizeof(carg2_buf)
    },
    {
        .type = ARG_TYPE_VAR,
        .buffer = carg3_buf,
        .len = sizeof(carg3_buf)
    }
 
};
static cmd_info_t call3_info = {
    .name = "call3",
    .description = "call3 <function> <arg1> <arg2> <arg3> -> call function(arg1,arg2,arg3).",
    .func = cmd_call3,
    .argc = 4,
    .argv = call3_argv
};
 
/** Data and methods for 'halt' command. */
static int cmd_halt(cmd_arg_t *argv);
static cmd_info_t halt_info = {
    .name = "halt",
    .description = "Halt the kernel.",
    .func = cmd_halt,
    .argc = 0
};
 
/** Initialize kconsole data structures. */
void kconsole_init(void)
{
    spinlock_initialize(&cmd_lock, "kconsole_cmd");
    list_initialize(&cmd_head);
   
    spinlock_initialize(&help_info.lock, "kconsole_help");
    link_initialize(&help_info.link);
    if (!cmd_register(&help_info))
        panic("could not register command %s\n", help_info.name);
 
 
    spinlock_initialize(&desc_info.lock, "kconsole_desc");
    link_initialize(&desc_info.link);
    if (!cmd_register(&desc_info))
        panic("could not register command %s\n", desc_info.name);
   
    spinlock_initialize(&symaddr_info.lock, "kconsole_symaddr");
    link_initialize(&symaddr_info.link);
    if (!cmd_register(&symaddr_info))
        panic("could not register command %s\n", symaddr_info.name);
 
    spinlock_initialize(&call0_info.lock, "kconsole_call0");
    link_initialize(&call0_info.link);
    if (!cmd_register(&call0_info))
        panic("could not register command %s\n", call0_info.name);
 
    spinlock_initialize(&call1_info.lock, "kconsole_call1");
    link_initialize(&call1_info.link);
    if (!cmd_register(&call1_info))
        panic("could not register command %s\n", call1_info.name);
 
 
    spinlock_initialize(&call2_info.lock, "kconsole_call2");
    link_initialize(&call2_info.link);
    if (!cmd_register(&call2_info))
        panic("could not register command %s\n", call2_info.name);
 
    spinlock_initialize(&call3_info.lock, "kconsole_call3");
    link_initialize(&call3_info.link);
    if (!cmd_register(&call3_info))
        panic("could not register command %s\n", call3_info.name);
   
    spinlock_initialize(&halt_info.lock, "kconsole_halt");
    link_initialize(&halt_info.link);
    if (!cmd_register(&halt_info))
        panic("could not register command %s\n", halt_info.name);
 
    spinlock_initialize(&desc_ptlb.lock, "kconsole_ptlb");
    link_initialize(&desc_ptlb.link);
    if (!cmd_register(&desc_ptlb))
        panic("could not register command %s\n", desc_ptlb.name);
}
 
 
/** Register kconsole command.
 *
 * @param cmd Structure describing the command.
 *
 * @return 0 on failure, 1 on success.
 */
int cmd_register(cmd_info_t *cmd)
{
    ipl_t ipl;
    link_t *cur;
   
    spinlock_lock(&cmd_lock);
   
    /*
     * Make sure the command is not already listed.
     */
    for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {
        cmd_info_t *hlp;
       
        hlp = list_get_instance(cur, cmd_info_t, link);
 
        if (hlp == cmd) {
            /* The command is already there. */
            spinlock_unlock(&cmd_lock);
            return 0;
        }
 
        /* Avoid deadlock. */
        if (hlp < cmd) {
            spinlock_lock(&hlp->lock);
            spinlock_lock(&cmd->lock);
        } else {
            spinlock_lock(&cmd->lock);
            spinlock_lock(&hlp->lock);
        }
       
        if ((strncmp(hlp->name, cmd->name, strlen(cmd->name)) == 0)) {
            /* The command is already there. */
            spinlock_unlock(&hlp->lock);
            spinlock_unlock(&cmd->lock);
            spinlock_unlock(&cmd_lock);
            return 0;
        }
       
        spinlock_unlock(&hlp->lock);
        spinlock_unlock(&cmd->lock);
    }
   
    /*
     * Now the command can be added.
     */
    list_append(&cmd->link, &cmd_head);
   
    spinlock_unlock(&cmd_lock);
    return 1;
}
 
/** Kernel console managing thread.
 *
 * @param arg Not used.
 */
void kconsole(void *arg)
{
    char cmdline[MAX_CMDLINE+1];
    cmd_info_t *cmd_info;
    count_t len;
 
    if (!stdin) {
        printf("%s: no stdin\n", __FUNCTION__);
        return;
    }
   
    while (true) {
        printf("%s> ", __FUNCTION__);
        if (!(len = gets(stdin, cmdline, sizeof(cmdline))))
            continue;
        cmdline[len] = '\0';
        cmd_info = parse_cmdline(cmdline, len);
        if (!cmd_info)
            continue;
        (void) cmd_info->func(cmd_info->argv);
    }
}
 
static int parse_int_arg(char *text, size_t len, __native *result)
{
    char symname[MAX_SYMBOL_NAME];
    __address symaddr;
    bool isaddr = false;
    bool isptr = false;
   
    /* If we get a name, try to find it in symbol table */
    if (text[0] < '0' | text[0] > '9') {
        if (text[0] == '&') {
            isaddr = true;
            text++;len--;
        } else if (text[0] == '*') {
            isptr = true;
            text++;len--;
        }
        strncpy(symname, text, min(len+1, MAX_SYMBOL_NAME));
        symaddr = get_symbol_addr(symname);
        if (!symaddr) {
            printf("Symbol %s not found.\n",symname);
            return -1;
        }
        if (symaddr == (__address) -1) {
            printf("Duplicate symbol %s.\n",symname);
            symtab_print_search(symname);
            return -1;
        }
        if (isaddr)
            *result = (__native)symaddr;
        else if (isptr)
            *result = **((__native **)symaddr);
        else
            *result = *((__native *)symaddr);
    } else /* It's a number - convert it */
        *result = atoi(text);
    return 0;
}
 
/** Parse command line.
 *
 * @param cmdline Command line as read from input device.
 * @param len Command line length.
 *
 * @return Structure describing the command.
 */
cmd_info_t *parse_cmdline(char *cmdline, size_t len)
{
    index_t start = 0, end = 0;
    cmd_info_t *cmd = NULL;
    link_t *cur;
    ipl_t ipl;
    int i;
   
    if (!parse_argument(cmdline, len, &start, &end)) {
        /* Command line did not contain alphanumeric word. */
        return NULL;
    }
 
    spinlock_lock(&cmd_lock);
   
    for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {
        cmd_info_t *hlp;
       
        hlp = list_get_instance(cur, cmd_info_t, link);
        spinlock_lock(&hlp->lock);
       
        if (strncmp(hlp->name, &cmdline[start], (end - start) + 1) == 0) {
            cmd = hlp;
            break;
        }
       
        spinlock_unlock(&hlp->lock);
    }
   
    spinlock_unlock(&cmd_lock);
   
    if (!cmd) {
        /* Unknown command. */
        printf("Unknown command.\n");
        return NULL;
    }
 
    /* cmd == hlp is locked */
   
    /*
     * The command line must be further analyzed and
     * the parameters therefrom must be matched and
     * converted to those specified in the cmd info
     * structure.
     */
 
    for (i = 0; i < cmd->argc; i++) {
        char *buf;
        start = end + 1;
        if (!parse_argument(cmdline, len, &start, &end)) {
            printf("Too few arguments.\n");
            spinlock_unlock(&cmd->lock);
            return NULL;
        }
       
        switch (cmd->argv[i].type) {
        case ARG_TYPE_STRING:
                buf = cmd->argv[i].buffer;
                strncpy(buf, (const char *) &cmdline[start], min((end - start) + 2, cmd->argv[i].len));
            buf[min((end - start) + 1, cmd->argv[i].len - 1)] = '\0';
            break;
        case ARG_TYPE_INT:
            if (parse_int_arg(cmdline+start, end-start+1,
                      &cmd->argv[i].intval))
                return NULL;
            break;
        case ARG_TYPE_VAR:
            if (start != end && cmdline[start] == '"' && cmdline[end] == '"') {
                buf = cmd->argv[i].buffer;
                strncpy(buf, (const char *) &cmdline[start+1],
                    min((end-start), cmd->argv[i].len));
                buf[min((end - start), cmd->argv[i].len - 1)] = '\0';
                cmd->argv[i].intval = (__native) buf;
                cmd->argv[i].vartype = ARG_TYPE_STRING;
            } else if (!parse_int_arg(cmdline+start, end-start+1,
                         &cmd->argv[i].intval))
                cmd->argv[i].vartype = ARG_TYPE_INT;
            else {
                printf("Unrecognized variable argument.\n");
                return NULL;
            }
            break;
        case ARG_TYPE_INVALID:
        default:
            printf("invalid argument type\n");
            return NULL;
            break;
        }
    }
   
    start = end + 1;
    if (parse_argument(cmdline, len, &start, &end)) {
        printf("Too many arguments.\n");
        spinlock_unlock(&cmd->lock);
        return NULL;
    }
   
    spinlock_unlock(&cmd->lock);
    return cmd;
}
 
/** Parse argument.
 *
 * Find start and end positions of command line argument.
 *
 * @param cmdline Command line as read from the input device.
 * @param len Number of characters in cmdline.
 * @param start On entry, 'start' contains pointer to the index
 *        of first unprocessed character of cmdline.
 *        On successful exit, it marks beginning of the next argument.
 * @param end Undefined on entry. On exit, 'end' points to the last character
 *        of the next argument.
 *
 * @return false on failure, true on success.
 */
bool parse_argument(char *cmdline, size_t len, index_t *start, index_t *end)
{
    int i;
    bool found_start = false;
   
    ASSERT(start != NULL);
    ASSERT(end != NULL);
   
    for (i = *start; i < len; i++) {
        if (!found_start) {
            if (is_white(cmdline[i]))
                (*start)++;
            else
                found_start = true;
        } else {
            if (is_white(cmdline[i]))
                break;
        }
    }
    *end = i - 1;
 
    return found_start;
}
 
 
/** List supported commands.
 *
 * @param argv Argument vector.
 *
 * @return 0 on failure, 1 on success.
 */
int cmd_help(cmd_arg_t *argv)
{
    link_t *cur;
    ipl_t ipl;
 
    spinlock_lock(&cmd_lock);
   
    for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {
        cmd_info_t *hlp;
       
        hlp = list_get_instance(cur, cmd_info_t, link);
        spinlock_lock(&hlp->lock);
       
        printf("%s - %s\n", hlp->name, hlp->description);
 
        spinlock_unlock(&hlp->lock);
    }
   
    spinlock_unlock(&cmd_lock);
 
    return 1;
}
 
/** Describe specified command.
 *
 * @param argv Argument vector.
 *
 * @return 0 on failure, 1 on success.
 */
int cmd_desc(cmd_arg_t *argv)
{
    link_t *cur;
    ipl_t ipl;
 
    spinlock_lock(&cmd_lock);
   
    for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {
        cmd_info_t *hlp;
       
        hlp = list_get_instance(cur, cmd_info_t, link);
        spinlock_lock(&hlp->lock);
 
        if (strncmp(hlp->name, (const char *) argv->buffer, strlen(hlp->name)) == 0) {
            printf("%s - %s\n", hlp->name, hlp->description);
            if (hlp->help)
                hlp->help();
            spinlock_unlock(&hlp->lock);
            break;
        }
 
        spinlock_unlock(&hlp->lock);
    }
   
    spinlock_unlock(&cmd_lock);
 
    return 1;
}
 
/** Search symbol table */
int cmd_symaddr(cmd_arg_t *argv)
{
    __address symaddr;
    char *symbol;
 
    symtab_print_search(argv->buffer);
   
    return 1;
}
 
/** Call function with zero parameters */
int cmd_call0(cmd_arg_t *argv)
{
    __address symaddr;
    char *symbol;
    __native (*f)(void);
 
    symaddr = get_symbol_addr(argv->buffer);
    if (!symaddr)
        printf("Symbol %s not found.\n", argv->buffer);
    else if (symaddr == (__address) -1) {
        symtab_print_search(argv->buffer);
        printf("Duplicate symbol, be more specific.\n");
    } else {
        symbol = get_symtab_entry(symaddr);
        printf("Calling f(): 0x%p: %s\n", symaddr, symbol);
        f =  (__native (*)(void)) symaddr;
        printf("Result: 0x%X\n", f());
    }
   
    return 1;
}
 
/** Call function with one parameter */
int cmd_call1(cmd_arg_t *argv)
{
    __address symaddr;
    char *symbol;
    __native (*f)(__native);
    __native arg1 = argv[1].intval;
 
    symaddr = get_symbol_addr(argv->buffer);
    if (!symaddr)
        printf("Symbol %s not found.\n", argv->buffer);
    else if (symaddr == (__address) -1) {
        symtab_print_search(argv->buffer);
        printf("Duplicate symbol, be more specific.\n");
    } else {
        symbol = get_symtab_entry(symaddr);
        printf("Calling f(0x%x): 0x%p: %s\n", arg1, symaddr, symbol);
        f =  (__native (*)(__native)) symaddr;
        printf("Result: 0x%x\n", f(arg1));
    }
   
    return 1;
}
 
/** Call function with two parameters */
int cmd_call2(cmd_arg_t *argv)
{
    __address symaddr;
    char *symbol;
    __native (*f)(__native,__native);
    __native arg1 = argv[1].intval;
    __native arg2 = argv[2].intval;
 
    symaddr = get_symbol_addr(argv->buffer);
    if (!symaddr)
        printf("Symbol %s not found.\n", argv->buffer);
    else if (symaddr == (__address) -1) {
        symtab_print_search(argv->buffer);
        printf("Duplicate symbol, be more specific.\n");
    } else {
        symbol = get_symtab_entry(symaddr);
        printf("Calling f(0x%x,0x%x): 0x%p: %s\n",
               arg1, arg2, symaddr, symbol);
        f =  (__native (*)(__native,__native)) symaddr;
        printf("Result: 0x%x\n", f(arg1, arg2));
    }
   
    return 1;
}
 
/** Call function with three parameters */
int cmd_call3(cmd_arg_t *argv)
{
    __address symaddr;
    char *symbol;
    __native (*f)(__native,__native,__native);
    __native arg1 = argv[1].intval;
    __native arg2 = argv[2].intval;
    __native arg3 = argv[3].intval;
 
    symaddr = get_symbol_addr(argv->buffer);
    if (!symaddr)
        printf("Symbol %s not found.\n", argv->buffer);
    else if (symaddr == (__address) -1) {
        symtab_print_search(argv->buffer);
        printf("Duplicate symbol, be more specific.\n");
    } else {
        symbol = get_symtab_entry(symaddr);
        printf("Calling f(0x%x,0x%x, 0x%x): 0x%p: %s\n",
               arg1, arg2, arg3, symaddr, symbol);
        f =  (__native (*)(__native,__native,__native)) symaddr;
        printf("Result: 0x%x\n", f(arg1, arg2, arg3));
    }
   
    return 1;
}
 
 
/** Print detailed description of 'describe' command. */
void desc_help(void)
{
    printf("Syntax: describe command_name\n");
}
 
/** Halt the kernel.
 *
 * @param argv Argument vector (ignored).
 *
 * @return 0 on failure, 1 on success (never returns).
 */
int cmd_halt(cmd_arg_t *argv)
{
    halt();
    return 1;
}
 

Rev 591	Rev 594
1	/*	1	/*
2	* Copyright (C) 2005 Jakub Jermar	2	* Copyright (C) 2005 Jakub Jermar
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	#include <console/kconsole.h>	29	#include <console/kconsole.h>
30	#include <console/console.h>	30	#include <console/console.h>
31	#include <console/chardev.h>	31	#include <console/chardev.h>
32	#include <print.h>	32	#include <print.h>
33	#include <panic.h>	33	#include <panic.h>
34	#include <typedefs.h>	34	#include <typedefs.h>
35	#include <arch/types.h>	35	#include <arch/types.h>
36	#include <list.h>	36	#include <list.h>
37	#include <arch.h>	37	#include <arch.h>
38	#include <func.h>	38	#include <func.h>
39	#include <macros.h>	39	#include <macros.h>
40	#include <debug.h>	40	#include <debug.h>
41	#include <symtab.h>	41	#include <symtab.h>
42		42
-		43	#include <mm/tlb_cmd.h>
-		44
43	#define MAX_CMDLINE 256	45	#define MAX_CMDLINE 256
44		46
45	/** Simple kernel console.	47	/** Simple kernel console.
46	*	48	*
47	* The console is realized by kernel thread kconsole.	49	* The console is realized by kernel thread kconsole.
48	* It doesn't understand any useful command on its own,	50	* It doesn't understand any useful command on its own,
49	* but makes it possible for other kernel subsystems to	51	* but makes it possible for other kernel subsystems to
50	* register their own commands.	52	* register their own commands.
51	*/	53	*/
52		54
53	/** Locking.	55	/** Locking.
54	*	56	*
55	* There is a list of cmd_info_t structures. This list	57	* There is a list of cmd_info_t structures. This list
56	* is protected by cmd_lock spinlock. Note that specially	58	* is protected by cmd_lock spinlock. Note that specially
57	* the link elements of cmd_info_t are protected by	59	* the link elements of cmd_info_t are protected by
58	* this lock.	60	* this lock.
59	*	61	*
60	* Each cmd_info_t also has its own lock, which protects	62	* Each cmd_info_t also has its own lock, which protects
61	* all elements thereof except the link element.	63	* all elements thereof except the link element.
62	*	64	*
63	* cmd_lock must be acquired before any cmd_info lock.	65	* cmd_lock must be acquired before any cmd_info lock.
64	* When locking two cmd info structures, structure with	66	* When locking two cmd info structures, structure with
65	* lower address must be locked first.	67	* lower address must be locked first.
66	*/	68	*/
67		69
68	spinlock_t cmd_lock; /*< Lock protecting command list. /	70	spinlock_t cmd_lock; /*< Lock protecting command list. /
69	link_t cmd_head; /*< Command list. /	71	link_t cmd_head; /*< Command list. /
70		72
71	static cmd_info_t parse_cmdline(char cmdline, size_t len);	73	static cmd_info_t parse_cmdline(char cmdline, size_t len);
72	static bool parse_argument(char cmdline, size_t len, index_t start, index_t *end);	74	static bool parse_argument(char cmdline, size_t len, index_t start, index_t *end);
73		75
74	/** Data and methods for 'help' command. */	76	/** Data and methods for 'help' command. */
75	static int cmd_help(cmd_arg_t *argv);	77	static int cmd_help(cmd_arg_t *argv);
76	static cmd_info_t help_info = {	78	static cmd_info_t help_info = {
77	.name = "help",	79	.name = "help",
78	.description = "List of supported commands.",	80	.description = "List of supported commands.",
79	.func = cmd_help,	81	.func = cmd_help,
80	.argc = 0	82	.argc = 0
81	};	83	};
82		84
83	/** Data and methods for 'description' command. */	85	/** Data and methods for 'description' command. */
84	static int cmd_desc(cmd_arg_t *argv);	86	static int cmd_desc(cmd_arg_t *argv);
85	static void desc_help(void);	87	static void desc_help(void);
86	static char desc_buf[MAX_CMDLINE+1];	88	static char desc_buf[MAX_CMDLINE+1];
87	static cmd_arg_t desc_argv = {	89	static cmd_arg_t desc_argv = {
88	.type = ARG_TYPE_STRING,	90	.type = ARG_TYPE_STRING,
89	.buffer = desc_buf,	91	.buffer = desc_buf,
90	.len = sizeof(desc_buf)	92	.len = sizeof(desc_buf)
91	};	93	};
92	static cmd_info_t desc_info = {	94	static cmd_info_t desc_info = {
93	.name = "describe",	95	.name = "describe",
94	.description = "Describe specified command.",	96	.description = "Describe specified command.",
95	.help = desc_help,	97	.help = desc_help,
96	.func = cmd_desc,	98	.func = cmd_desc,
97	.argc = 1,	99	.argc = 1,
98	.argv = &desc_argv	100	.argv = &desc_argv
99	};	101	};
100		102
101	/** Data and methods for 'symaddr' command. */	103	/** Data and methods for 'symaddr' command. */
102	static int cmd_symaddr(cmd_arg_t *argv);	104	static int cmd_symaddr(cmd_arg_t *argv);
103	static char symaddr_buf[MAX_CMDLINE+1];	105	static char symaddr_buf[MAX_CMDLINE+1];
104	static cmd_arg_t symaddr_argv = {	106	static cmd_arg_t symaddr_argv = {
105	.type = ARG_TYPE_STRING,	107	.type = ARG_TYPE_STRING,
106	.buffer = symaddr_buf,	108	.buffer = symaddr_buf,
107	.len = sizeof(symaddr_buf)	109	.len = sizeof(symaddr_buf)
108	};	110	};
109	static cmd_info_t symaddr_info = {	111	static cmd_info_t symaddr_info = {
110	.name = "symaddr",	112	.name = "symaddr",
111	.description = "Return symbol address.",	113	.description = "Return symbol address.",
112	.func = cmd_symaddr,	114	.func = cmd_symaddr,
113	.argc = 1,	115	.argc = 1,
114	.argv = &symaddr_argv	116	.argv = &symaddr_argv
115	};	117	};
116		118
117	/** Call0 - call function with no parameters */	119	/** Call0 - call function with no parameters */
118	static char call0_buf[MAX_CMDLINE+1];	120	static char call0_buf[MAX_CMDLINE+1];
119	static char carg1_buf[MAX_CMDLINE+1];	121	static char carg1_buf[MAX_CMDLINE+1];
120	static char carg2_buf[MAX_CMDLINE+1];	122	static char carg2_buf[MAX_CMDLINE+1];
121	static char carg3_buf[MAX_CMDLINE+1];	123	static char carg3_buf[MAX_CMDLINE+1];
122		124
123	static int cmd_call0(cmd_arg_t *argv);	125	static int cmd_call0(cmd_arg_t *argv);
124	static cmd_arg_t call0_argv = {	126	static cmd_arg_t call0_argv = {
125	.type = ARG_TYPE_STRING,	127	.type = ARG_TYPE_STRING,
126	.buffer = call0_buf,	128	.buffer = call0_buf,
127	.len = sizeof(call0_buf)	129	.len = sizeof(call0_buf)
128	};	130	};
129	static cmd_info_t call0_info = {	131	static cmd_info_t call0_info = {
130	.name = "call0",	132	.name = "call0",
131	.description = "call0 <function> -> call function().",	133	.description = "call0 <function> -> call function().",
132	.func = cmd_call0,	134	.func = cmd_call0,
133	.argc = 1,	135	.argc = 1,
134	.argv = &call0_argv	136	.argv = &call0_argv
135	};	137	};
136		138
137	static int cmd_call1(cmd_arg_t *argv);	139	static int cmd_call1(cmd_arg_t *argv);
138	static cmd_arg_t call1_argv[] = {	140	static cmd_arg_t call1_argv[] = {
139	{	141	{
140	.type = ARG_TYPE_STRING,	142	.type = ARG_TYPE_STRING,
141	.buffer = call0_buf,	143	.buffer = call0_buf,
142	.len = sizeof(call0_buf)	144	.len = sizeof(call0_buf)
143	},	145	},
144	{	146	{
145	.type = ARG_TYPE_VAR,	147	.type = ARG_TYPE_VAR,
146	.buffer = carg1_buf,	148	.buffer = carg1_buf,
147	.len = sizeof(carg1_buf)	149	.len = sizeof(carg1_buf)
148	}	150	}
149	};	151	};
150	static cmd_info_t call1_info = {	152	static cmd_info_t call1_info = {
151	.name = "call1",	153	.name = "call1",
152	.description = "call1 <function> <arg1> -> call function(arg1).",	154	.description = "call1 <function> <arg1> -> call function(arg1).",
153	.func = cmd_call1,	155	.func = cmd_call1,
154	.argc = 2,	156	.argc = 2,
155	.argv = call1_argv	157	.argv = call1_argv
156	};	158	};
157		159
158	static int cmd_call2(cmd_arg_t *argv);	160	static int cmd_call2(cmd_arg_t *argv);
159	static cmd_arg_t call2_argv[] = {	161	static cmd_arg_t call2_argv[] = {
160	{	162	{
161	.type = ARG_TYPE_STRING,	163	.type = ARG_TYPE_STRING,
162	.buffer = call0_buf,	164	.buffer = call0_buf,
163	.len = sizeof(call0_buf)	165	.len = sizeof(call0_buf)
164	},	166	},
165	{	167	{
166	.type = ARG_TYPE_VAR,	168	.type = ARG_TYPE_VAR,
167	.buffer = carg1_buf,	169	.buffer = carg1_buf,
168	.len = sizeof(carg1_buf)	170	.len = sizeof(carg1_buf)
169	},	171	},
170	{	172	{
171	.type = ARG_TYPE_VAR,	173	.type = ARG_TYPE_VAR,
172	.buffer = carg2_buf,	174	.buffer = carg2_buf,
173	.len = sizeof(carg2_buf)	175	.len = sizeof(carg2_buf)
174	}	176	}
175	};	177	};
176	static cmd_info_t call2_info = {	178	static cmd_info_t call2_info = {
177	.name = "call2",	179	.name = "call2",
178	.description = "call2 <function> <arg1> <arg2> -> call function(arg1,arg2).",	180	.description = "call2 <function> <arg1> <arg2> -> call function(arg1,arg2).",
179	.func = cmd_call2,	181	.func = cmd_call2,
180	.argc = 3,	182	.argc = 3,
181	.argv = call2_argv	183	.argv = call2_argv
182	};	184	};
183		185
184	static int cmd_call3(cmd_arg_t *argv);	186	static int cmd_call3(cmd_arg_t *argv);
185	static cmd_arg_t call3_argv[] = {	187	static cmd_arg_t call3_argv[] = {
186	{	188	{
187	.type = ARG_TYPE_STRING,	189	.type = ARG_TYPE_STRING,
188	.buffer = call0_buf,	190	.buffer = call0_buf,
189	.len = sizeof(call0_buf)	191	.len = sizeof(call0_buf)
190	},	192	},
191	{	193	{
192	.type = ARG_TYPE_VAR,	194	.type = ARG_TYPE_VAR,
193	.buffer = carg1_buf,	195	.buffer = carg1_buf,
194	.len = sizeof(carg1_buf)	196	.len = sizeof(carg1_buf)
195	},	197	},
196	{	198	{
197	.type = ARG_TYPE_VAR,	199	.type = ARG_TYPE_VAR,
198	.buffer = carg2_buf,	200	.buffer = carg2_buf,
199	.len = sizeof(carg2_buf)	201	.len = sizeof(carg2_buf)
200	},	202	},
201	{	203	{
202	.type = ARG_TYPE_VAR,	204	.type = ARG_TYPE_VAR,
203	.buffer = carg3_buf,	205	.buffer = carg3_buf,
204	.len = sizeof(carg3_buf)	206	.len = sizeof(carg3_buf)
205	}	207	}
206		208
207	};	209	};
208	static cmd_info_t call3_info = {	210	static cmd_info_t call3_info = {
209	.name = "call3",	211	.name = "call3",
210	.description = "call3 <function> <arg1> <arg2> <arg3> -> call function(arg1,arg2,arg3).",	212	.description = "call3 <function> <arg1> <arg2> <arg3> -> call function(arg1,arg2,arg3).",
211	.func = cmd_call3,	213	.func = cmd_call3,
212	.argc = 4,	214	.argc = 4,
213	.argv = call3_argv	215	.argv = call3_argv
214	};	216	};
215		217
216	/** Data and methods for 'halt' command. */	218	/** Data and methods for 'halt' command. */
217	static int cmd_halt(cmd_arg_t *argv);	219	static int cmd_halt(cmd_arg_t *argv);
218	static cmd_info_t halt_info = {	220	static cmd_info_t halt_info = {
219	.name = "halt",	221	.name = "halt",
220	.description = "Halt the kernel.",	222	.description = "Halt the kernel.",
221	.func = cmd_halt,	223	.func = cmd_halt,
222	.argc = 0	224	.argc = 0
223	};	225	};
224		226
225	/** Initialize kconsole data structures. */	227	/** Initialize kconsole data structures. */
226	void kconsole_init(void)	228	void kconsole_init(void)
227	{	229	{
228	spinlock_initialize(&cmd_lock, "kconsole_cmd");	230	spinlock_initialize(&cmd_lock, "kconsole_cmd");
229	list_initialize(&cmd_head);	231	list_initialize(&cmd_head);
230		232
231	spinlock_initialize(&help_info.lock, "kconsole_help");	233	spinlock_initialize(&help_info.lock, "kconsole_help");
232	link_initialize(&help_info.link);	234	link_initialize(&help_info.link);
233	if (!cmd_register(&help_info))	235	if (!cmd_register(&help_info))
234	panic("could not register command %s\n", help_info.name);	236	panic("could not register command %s\n", help_info.name);
235		237
236		238
237	spinlock_initialize(&desc_info.lock, "kconsole_desc");	239	spinlock_initialize(&desc_info.lock, "kconsole_desc");
238	link_initialize(&desc_info.link);	240	link_initialize(&desc_info.link);
239	if (!cmd_register(&desc_info))	241	if (!cmd_register(&desc_info))
240	panic("could not register command %s\n", desc_info.name);	242	panic("could not register command %s\n", desc_info.name);
241		243
242	spinlock_initialize(&symaddr_info.lock, "kconsole_symaddr");	244	spinlock_initialize(&symaddr_info.lock, "kconsole_symaddr");
243	link_initialize(&symaddr_info.link);	245	link_initialize(&symaddr_info.link);
244	if (!cmd_register(&symaddr_info))	246	if (!cmd_register(&symaddr_info))
245	panic("could not register command %s\n", symaddr_info.name);	247	panic("could not register command %s\n", symaddr_info.name);
246		248
247	spinlock_initialize(&call0_info.lock, "kconsole_call0");	249	spinlock_initialize(&call0_info.lock, "kconsole_call0");
248	link_initialize(&call0_info.link);	250	link_initialize(&call0_info.link);
249	if (!cmd_register(&call0_info))	251	if (!cmd_register(&call0_info))
250	panic("could not register command %s\n", call0_info.name);	252	panic("could not register command %s\n", call0_info.name);
251		253
252	spinlock_initialize(&call1_info.lock, "kconsole_call1");	254	spinlock_initialize(&call1_info.lock, "kconsole_call1");
253	link_initialize(&call1_info.link);	255	link_initialize(&call1_info.link);
254	if (!cmd_register(&call1_info))	256	if (!cmd_register(&call1_info))
255	panic("could not register command %s\n", call1_info.name);	257	panic("could not register command %s\n", call1_info.name);
256		258
257		259
258	spinlock_initialize(&call2_info.lock, "kconsole_call2");	260	spinlock_initialize(&call2_info.lock, "kconsole_call2");
259	link_initialize(&call2_info.link);	261	link_initialize(&call2_info.link);
260	if (!cmd_register(&call2_info))	262	if (!cmd_register(&call2_info))
261	panic("could not register command %s\n", call2_info.name);	263	panic("could not register command %s\n", call2_info.name);
262		264
263	spinlock_initialize(&call3_info.lock, "kconsole_call3");	265	spinlock_initialize(&call3_info.lock, "kconsole_call3");
264	link_initialize(&call3_info.link);	266	link_initialize(&call3_info.link);
265	if (!cmd_register(&call3_info))	267	if (!cmd_register(&call3_info))
266	panic("could not register command %s\n", call3_info.name);	268	panic("could not register command %s\n", call3_info.name);
267		269
268	spinlock_initialize(&halt_info.lock, "kconsole_halt");	270	spinlock_initialize(&halt_info.lock, "kconsole_halt");
269	link_initialize(&halt_info.link);	271	link_initialize(&halt_info.link);
270	if (!cmd_register(&halt_info))	272	if (!cmd_register(&halt_info))
271	panic("could not register command %s\n", halt_info.name);	273	panic("could not register command %s\n", halt_info.name);
-		274
-		275	spinlock_initialize(&desc_ptlb.lock, "kconsole_ptlb");
-		276	link_initialize(&desc_ptlb.link);
-		277	if (!cmd_register(&desc_ptlb))
-		278	panic("could not register command %s\n", desc_ptlb.name);
272	}	279	}
273		280
274		281
275	/** Register kconsole command.	282	/** Register kconsole command.
276	*	283	*
277	* @param cmd Structure describing the command.	284	* @param cmd Structure describing the command.
278	*	285	*
279	* @return 0 on failure, 1 on success.	286	* @return 0 on failure, 1 on success.
280	*/	287	*/
281	int cmd_register(cmd_info_t *cmd)	288	int cmd_register(cmd_info_t *cmd)
282	{	289	{
283	ipl_t ipl;	290	ipl_t ipl;
284	link_t *cur;	291	link_t *cur;
285		292
286	spinlock_lock(&cmd_lock);	293	spinlock_lock(&cmd_lock);
287		294
288	/*	295	/*
289	* Make sure the command is not already listed.	296	* Make sure the command is not already listed.
290	*/	297	*/
291	for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {	298	for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {
292	cmd_info_t *hlp;	299	cmd_info_t *hlp;
293		300
294	hlp = list_get_instance(cur, cmd_info_t, link);	301	hlp = list_get_instance(cur, cmd_info_t, link);
295		302
296	if (hlp == cmd) {	303	if (hlp == cmd) {
297	/* The command is already there. */	304	/* The command is already there. */
298	spinlock_unlock(&cmd_lock);	305	spinlock_unlock(&cmd_lock);
299	return 0;	306	return 0;
300	}	307	}
301		308
302	/* Avoid deadlock. */	309	/* Avoid deadlock. */
303	if (hlp < cmd) {	310	if (hlp < cmd) {
304	spinlock_lock(&hlp->lock);	311	spinlock_lock(&hlp->lock);
305	spinlock_lock(&cmd->lock);	312	spinlock_lock(&cmd->lock);
306	} else {	313	} else {
307	spinlock_lock(&cmd->lock);	314	spinlock_lock(&cmd->lock);
308	spinlock_lock(&hlp->lock);	315	spinlock_lock(&hlp->lock);
309	}	316	}
310		317
311	if ((strncmp(hlp->name, cmd->name, strlen(cmd->name)) == 0)) {	318	if ((strncmp(hlp->name, cmd->name, strlen(cmd->name)) == 0)) {
312	/* The command is already there. */	319	/* The command is already there. */
313	spinlock_unlock(&hlp->lock);	320	spinlock_unlock(&hlp->lock);
314	spinlock_unlock(&cmd->lock);	321	spinlock_unlock(&cmd->lock);
315	spinlock_unlock(&cmd_lock);	322	spinlock_unlock(&cmd_lock);
316	return 0;	323	return 0;
317	}	324	}
318		325
319	spinlock_unlock(&hlp->lock);	326	spinlock_unlock(&hlp->lock);
320	spinlock_unlock(&cmd->lock);	327	spinlock_unlock(&cmd->lock);
321	}	328	}
322		329
323	/*	330	/*
324	* Now the command can be added.	331	* Now the command can be added.
325	*/	332	*/
326	list_append(&cmd->link, &cmd_head);	333	list_append(&cmd->link, &cmd_head);
327		334
328	spinlock_unlock(&cmd_lock);	335	spinlock_unlock(&cmd_lock);
329	return 1;	336	return 1;
330	}	337	}
331		338
332	/** Kernel console managing thread.	339	/** Kernel console managing thread.
333	*	340	*
334	* @param arg Not used.	341	* @param arg Not used.
335	*/	342	*/
336	void kconsole(void *arg)	343	void kconsole(void *arg)
337	{	344	{
338	char cmdline[MAX_CMDLINE+1];	345	char cmdline[MAX_CMDLINE+1];
339	cmd_info_t *cmd_info;	346	cmd_info_t *cmd_info;
340	count_t len;	347	count_t len;
341		348
342	if (!stdin) {	349	if (!stdin) {
343	printf("%s: no stdin\n", __FUNCTION__);	350	printf("%s: no stdin\n", __FUNCTION__);
344	return;	351	return;
345	}	352	}
346		353
347	while (true) {	354	while (true) {
348	printf("%s> ", __FUNCTION__);	355	printf("%s> ", __FUNCTION__);
349	if (!(len = gets(stdin, cmdline, sizeof(cmdline))))	356	if (!(len = gets(stdin, cmdline, sizeof(cmdline))))
350	continue;	357	continue;
351	cmdline[len] = '\0';	358	cmdline[len] = '\0';
352	cmd_info = parse_cmdline(cmdline, len);	359	cmd_info = parse_cmdline(cmdline, len);
353	if (!cmd_info)	360	if (!cmd_info)
354	continue;	361	continue;
355	(void) cmd_info->func(cmd_info->argv);	362	(void) cmd_info->func(cmd_info->argv);
356	}	363	}
357	}	364	}
358		365
359	static int parse_int_arg(char text, size_t len, __native result)	366	static int parse_int_arg(char text, size_t len, __native result)
360	{	367	{
361	char symname[MAX_SYMBOL_NAME];	368	char symname[MAX_SYMBOL_NAME];
362	__address symaddr;	369	__address symaddr;
363	bool isaddr = false;	370	bool isaddr = false;
364	bool isptr = false;	371	bool isptr = false;
365		372
366	/* If we get a name, try to find it in symbol table */	373	/* If we get a name, try to find it in symbol table */
367	if (text[0] < '0' \| text[0] > '9') {	374	if (text[0] < '0' \| text[0] > '9') {
368	if (text[0] == '&') {	375	if (text[0] == '&') {
369	isaddr = true;	376	isaddr = true;
370	text++;len--;	377	text++;len--;
371	} else if (text[0] == '*') {	378	} else if (text[0] == '*') {
372	isptr = true;	379	isptr = true;
373	text++;len--;	380	text++;len--;
374	}	381	}
375	strncpy(symname, text, min(len+1, MAX_SYMBOL_NAME));	382	strncpy(symname, text, min(len+1, MAX_SYMBOL_NAME));
376	symaddr = get_symbol_addr(symname);	383	symaddr = get_symbol_addr(symname);
377	if (!symaddr) {	384	if (!symaddr) {
378	printf("Symbol %s not found.\n",symname);	385	printf("Symbol %s not found.\n",symname);
379	return -1;	386	return -1;
380	}	387	}
381	if (symaddr == (__address) -1) {	388	if (symaddr == (__address) -1) {
382	printf("Duplicate symbol %s.\n",symname);	389	printf("Duplicate symbol %s.\n",symname);
383	symtab_print_search(symname);	390	symtab_print_search(symname);
384	return -1;	391	return -1;
385	}	392	}
386	if (isaddr)	393	if (isaddr)
387	*result = (__native)symaddr;	394	*result = (__native)symaddr;
388	else if (isptr)	395	else if (isptr)
389	result = ((__native *)symaddr);	396	result = ((__native *)symaddr);
390	else	397	else
391	result = ((__native *)symaddr);	398	result = ((__native *)symaddr);
392	} else /* It's a number - convert it */	399	} else /* It's a number - convert it */
393	*result = atoi(text);	400	*result = atoi(text);
394	return 0;	401	return 0;
395	}	402	}
396		403
397	/** Parse command line.	404	/** Parse command line.
398	*	405	*
399	* @param cmdline Command line as read from input device.	406	* @param cmdline Command line as read from input device.
400	* @param len Command line length.	407	* @param len Command line length.
401	*	408	*
402	* @return Structure describing the command.	409	* @return Structure describing the command.
403	*/	410	*/
404	cmd_info_t parse_cmdline(char cmdline, size_t len)	411	cmd_info_t parse_cmdline(char cmdline, size_t len)
405	{	412	{
406	index_t start = 0, end = 0;	413	index_t start = 0, end = 0;
407	cmd_info_t *cmd = NULL;	414	cmd_info_t *cmd = NULL;
408	link_t *cur;	415	link_t *cur;
409	ipl_t ipl;	416	ipl_t ipl;
410	int i;	417	int i;
411		418
412	if (!parse_argument(cmdline, len, &start, &end)) {	419	if (!parse_argument(cmdline, len, &start, &end)) {
413	/* Command line did not contain alphanumeric word. */	420	/* Command line did not contain alphanumeric word. */
414	return NULL;	421	return NULL;
415	}	422	}
416		423
417	spinlock_lock(&cmd_lock);	424	spinlock_lock(&cmd_lock);
418		425
419	for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {	426	for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {
420	cmd_info_t *hlp;	427	cmd_info_t *hlp;
421		428
422	hlp = list_get_instance(cur, cmd_info_t, link);	429	hlp = list_get_instance(cur, cmd_info_t, link);
423	spinlock_lock(&hlp->lock);	430	spinlock_lock(&hlp->lock);
424		431
425	if (strncmp(hlp->name, &cmdline[start], (end - start) + 1) == 0) {	432	if (strncmp(hlp->name, &cmdline[start], (end - start) + 1) == 0) {
426	cmd = hlp;	433	cmd = hlp;
427	break;	434	break;
428	}	435	}
429		436
430	spinlock_unlock(&hlp->lock);	437	spinlock_unlock(&hlp->lock);
431	}	438	}
432		439
433	spinlock_unlock(&cmd_lock);	440	spinlock_unlock(&cmd_lock);
434		441
435	if (!cmd) {	442	if (!cmd) {
436	/* Unknown command. */	443	/* Unknown command. */
437	printf("Unknown command.\n");	444	printf("Unknown command.\n");
438	return NULL;	445	return NULL;
439	}	446	}
440		447
441	/* cmd == hlp is locked */	448	/* cmd == hlp is locked */
442		449
443	/*	450	/*
444	* The command line must be further analyzed and	451	* The command line must be further analyzed and
445	* the parameters therefrom must be matched and	452	* the parameters therefrom must be matched and
446	* converted to those specified in the cmd info	453	* converted to those specified in the cmd info
447	* structure.	454	* structure.
448	*/	455	*/
449		456
450	for (i = 0; i < cmd->argc; i++) {	457	for (i = 0; i < cmd->argc; i++) {
451	char *buf;	458	char *buf;
452	start = end + 1;	459	start = end + 1;
453	if (!parse_argument(cmdline, len, &start, &end)) {	460	if (!parse_argument(cmdline, len, &start, &end)) {
454	printf("Too few arguments.\n");	461	printf("Too few arguments.\n");
455	spinlock_unlock(&cmd->lock);	462	spinlock_unlock(&cmd->lock);
456	return NULL;	463	return NULL;
457	}	464	}
458		465
459	switch (cmd->argv[i].type) {	466	switch (cmd->argv[i].type) {
460	case ARG_TYPE_STRING:	467	case ARG_TYPE_STRING:
461	buf = cmd->argv[i].buffer;	468	buf = cmd->argv[i].buffer;
462	strncpy(buf, (const char *) &cmdline[start], min((end - start) + 2, cmd->argv[i].len));	469	strncpy(buf, (const char *) &cmdline[start], min((end - start) + 2, cmd->argv[i].len));
463	buf[min((end - start) + 1, cmd->argv[i].len - 1)] = '\0';	470	buf[min((end - start) + 1, cmd->argv[i].len - 1)] = '\0';
464	break;	471	break;
465	case ARG_TYPE_INT:	472	case ARG_TYPE_INT:
466	if (parse_int_arg(cmdline+start, end-start+1,	473	if (parse_int_arg(cmdline+start, end-start+1,
467	&cmd->argv[i].intval))	474	&cmd->argv[i].intval))
468	return NULL;	475	return NULL;
469	break;	476	break;
470	case ARG_TYPE_VAR:	477	case ARG_TYPE_VAR:
471	if (start != end && cmdline[start] == '"' && cmdline[end] == '"') {	478	if (start != end && cmdline[start] == '"' && cmdline[end] == '"') {
472	buf = cmd->argv[i].buffer;	479	buf = cmd->argv[i].buffer;
473	strncpy(buf, (const char *) &cmdline[start+1],	480	strncpy(buf, (const char *) &cmdline[start+1],
474	min((end-start), cmd->argv[i].len));	481	min((end-start), cmd->argv[i].len));
475	buf[min((end - start), cmd->argv[i].len - 1)] = '\0';	482	buf[min((end - start), cmd->argv[i].len - 1)] = '\0';
476	cmd->argv[i].intval = (__native) buf;	483	cmd->argv[i].intval = (__native) buf;
477	cmd->argv[i].vartype = ARG_TYPE_STRING;	484	cmd->argv[i].vartype = ARG_TYPE_STRING;
478	} else if (!parse_int_arg(cmdline+start, end-start+1,	485	} else if (!parse_int_arg(cmdline+start, end-start+1,
479	&cmd->argv[i].intval))	486	&cmd->argv[i].intval))
480	cmd->argv[i].vartype = ARG_TYPE_INT;	487	cmd->argv[i].vartype = ARG_TYPE_INT;
481	else {	488	else {
482	printf("Unrecognized variable argument.\n");	489	printf("Unrecognized variable argument.\n");
483	return NULL;	490	return NULL;
484	}	491	}
485	break;	492	break;
486	case ARG_TYPE_INVALID:	493	case ARG_TYPE_INVALID:
487	default:	494	default:
488	printf("invalid argument type\n");	495	printf("invalid argument type\n");
489	return NULL;	496	return NULL;
490	break;	497	break;
491	}	498	}
492	}	499	}
493		500

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/generic/src/console/kconsole.c – Rev 591 → 594