WebSVN – HelenOS – Diff – /trunk/kernel/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.
 */
 
/** @addtogroup genericconsole
 * @{
 */
 
/**
 * @file  kconsole.c
 * @brief Kernel console.
 *
 * This file contains kernel thread managing the kernel console.
 *
 */
 
#include <console/kconsole.h>
#include <console/console.h>
#include <console/chardev.h>
#include <console/cmd.h>
#include <print.h>
#include <panic.h>
#include <arch/types.h>
#include <adt/list.h>
#include <arch.h>
#include <macros.h>
#include <debug.h>
#include <func.h>
#include <string.h>
#include <macros.h>
#include <sysinfo/sysinfo.h>
#include <ddi/device.h>
#include <symtab.h>
#include <errno.h>
#include <putchar.h>
#include <string.h>
 
/** 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_INITIALIZE(cmd_lock);  /**< Lock protecting command list. */
LIST_INITIALIZE(cmd_head);      /**< Command list. */
 
static wchar_t history[KCONSOLE_HISTORY][MAX_CMDLINE] = {};
static count_t history_pos = 0;
 
/** Initialize kconsole data structures
 *
 * This is the most basic initialization, almost no
 * other kernel subsystem is ready yet.
 *
 */
void kconsole_init(void)
{
    unsigned int i;
   
    cmd_init();
    for (i = 0; i < KCONSOLE_HISTORY; i++)
        history[i][0] = 0;
}
 
/** Register kconsole command.
 *
 * @param cmd Structure describing the command.
 *
 * @return False on failure, true on success.
 *
 */
bool cmd_register(cmd_info_t *cmd)
{
    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 = list_get_instance(cur, cmd_info_t, link);
       
        if (hlp == cmd) {
            /* The command is already there. */
            spinlock_unlock(&cmd_lock);
            return false;
        }
       
        /* Avoid deadlock. */
        if (hlp < cmd) {
            spinlock_lock(&hlp->lock);
            spinlock_lock(&cmd->lock);
        } else {
            spinlock_lock(&cmd->lock);
            spinlock_lock(&hlp->lock);
        }
       
        if (str_cmp(hlp->name, cmd->name) == 0) {
            /* The command is already there. */
            spinlock_unlock(&hlp->lock);
            spinlock_unlock(&cmd->lock);
            spinlock_unlock(&cmd_lock);
            return false;
        }
       
        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 true;
}
 
/** Print count times a character */
static void print_cc(wchar_t ch, count_t count)
{
    count_t i;
    for (i = 0; i < count; i++)
        putchar(ch);
}
 
/** Try to find a command beginning with prefix */
static const char *cmdtab_search_one(const char *name, link_t **startpos)
{
    count_t namelen = str_length(name);
   
    spinlock_lock(&cmd_lock);
   
    if (*startpos == NULL)
        *startpos = cmd_head.next;
   
    for (; *startpos != &cmd_head; *startpos = (*startpos)->next) {
        cmd_info_t *hlp = list_get_instance(*startpos, cmd_info_t, link);
       
        const char *curname = hlp->name;
        if (str_length(curname) < namelen)
            continue;
       
        if (str_lcmp(curname, name, namelen) == 0) {
            spinlock_unlock(&cmd_lock);
            return (curname + str_lsize(curname, namelen));
        }
    }
   
    spinlock_unlock(&cmd_lock);
    return NULL;
}
 
/** Command completion of the commands
 *
 * @param name String to match, changed to hint on exit
 * @param size Input buffer size
 *
 * @return Number of found matches
 *
 */
static int cmdtab_compl(char *input, size_t size)
{
    const char *name = input;
   
    count_t found = 0;
    link_t *pos = NULL;
    const char *hint;
    char output[MAX_CMDLINE];
   
    output[0] = 0;
   
    while ((hint = cmdtab_search_one(name, &pos))) {
        if ((found == 0) || (str_length(output) > str_length(hint)))
            str_cpy(output, MAX_CMDLINE, hint);
       
        pos = pos->next;
        found++;
    }
   
    if ((found > 1) && (str_length(output) != 0)) {
        printf("\n");
        pos = NULL;
        while ((hint = cmdtab_search_one(name, &pos))) {
            cmd_info_t *hlp = list_get_instance(pos, cmd_info_t, link);
            printf("%s (%s)\n", hlp->name, hlp->description);
            pos = pos->next;
        }
    }
   
    if (found > 0)
        str_cpy(input, size, output);
   
    return found;
}
 
static wchar_t *clever_readline(const char *prompt, indev_t *indev)
{
    printf("%s> ", prompt);
   
    count_t position = 0;
    wchar_t *current = history[history_pos];
    current[0] = 0;
   
    while (true) {
        wchar_t ch = _getc(indev);
       
        if (ch == '\n') {
            /* Enter */
            putchar(ch);
            break;
        }
       
        if (ch == '\b') {
            /* Backspace */
            if (position == 0)
                continue;
           
            if (wstr_remove(current, position - 1)) {
                position--;
                putchar('\b');
                printf("%ls ", current + position);
                print_cc('\b', wstr_length(current) - position + 1);
                continue;
            }
        }
       
        if (ch == '\t') {
            /* Tab completion */
           
            /* Move to the end of the word */
            for (; (current[position] != 0) && (!isspace(current[position]));
                position++)
                putchar(current[position]);
           
            if (position == 0)
                continue;
           
            /* Find the beginning of the word
               and copy it to tmp */
            count_t beg;
            for (beg = position - 1; (beg > 0) && (!isspace(current[beg]));
                beg--);
           
            if (isspace(current[beg]))
                beg++;
           
            char tmp[STR_BOUNDS(MAX_CMDLINE)];
            wstr_nstr(tmp, current + beg, position - beg + 1);
           
            int found;
            if (beg == 0) {
                /* Command completion */
                found = cmdtab_compl(tmp, STR_BOUNDS(MAX_CMDLINE));
            } else {
                /* Symbol completion */
                found = symtab_compl(tmp, STR_BOUNDS(MAX_CMDLINE));
            }
           
            if (found == 0)
                continue;
           
            size_t off = 0;
            count_t i = 0;
            while ((ch = str_decode(tmp, &off, STR_NO_LIMIT)) != 0) {
                if (!wstr_linsert(current, ch, position + i, MAX_CMDLINE))
                    break;
                i++;
            }
           
            if ((str_length(tmp) > 0) || (found == 1)) {
                /* We have a hint */
                printf("%ls", current + position);
                print_cc('\b', wstr_length(current) - position);
                position += str_length(tmp);
               
                if ((found == 1) && (position == wstr_length(current))) {
                    if (wstr_linsert(current, ' ', position, MAX_CMDLINE)) {
                        printf("%ls", current + position);
                        position++;
                    }
                }
            } else {
                /* No unique hint, list was printed */
                printf("%s> ", prompt);
                printf("%ls", current);
                position += str_length(tmp);
            }
           
            print_cc('\b', wstr_length(current) - position);
            continue;
        }
       
        if (ch == U_LEFT_ARROW) {
            /* Left */
            if (position > 0) {
                putchar('\b');
                position--;
            }
            continue;
        }
       
        if (ch == U_RIGHT_ARROW) {
            /* Right */
            if (position < wstr_length(current)) {
                putchar(current[position]);
                position++;
            }
            continue;
        }
       
        if ((ch == U_UP_ARROW) || (ch == U_DOWN_ARROW)) {
            /* Up, down */
            print_cc('\b', position);
            print_cc(' ', wstr_length(current));
            print_cc('\b', wstr_length(current));
           
            if (ch == U_UP_ARROW) {
                /* Up */
                if (history_pos == 0)
                    history_pos = KCONSOLE_HISTORY - 1;
                else
                    history_pos--;
            } else {
                /* Down */
                history_pos++;
                history_pos = history_pos % KCONSOLE_HISTORY;
            }
            current = history[history_pos];
            printf("%ls", current);
            position = wstr_length(current);
            continue;
        }
       
        if (ch == U_HOME_ARROW) {
            /* Home */
            print_cc('\b', position);
            position = 0;
            continue;
        }
       
        if (ch == U_END_ARROW) {
            /* End */
            printf("%ls", current + position);
            position = wstr_length(current);
            continue;
        }
       
        if (ch == U_DELETE) {
            /* Delete */
            if (position == wstr_length(current))
                continue;
           
            if (wstr_remove(current, position)) {
                printf("%ls ", current + position);
                print_cc('\b', wstr_length(current) - position + 1);
            }
            continue;
        }
       
        if (wstr_linsert(current, ch, position, MAX_CMDLINE)) {
            printf("%ls", current + position);
            position++;
            print_cc('\b', wstr_length(current) - position);
        }
    }
   
    if (wstr_length(current) > 0) {
        history_pos++;
        history_pos = history_pos % KCONSOLE_HISTORY;
    }
   
    return current;
}
 
bool kconsole_check_poll(void)
{
    return check_poll(stdin);
}
 
static bool parse_int_arg(const char *text, size_t len, unative_t *result)
{
    bool isaddr = false;
    bool isptr = false;
   
    /* If we get a name, try to find it in symbol table */
    if (text[0] == '&') {
        isaddr = true;
        text++;
        len--;
    } else if (text[0] == '*') {
        isptr = true;
        text++;
        len--;
    }
   
    if ((text[0] < '0') || (text[0] > '9')) {
        char symname[MAX_SYMBOL_NAME];
        str_ncpy(symname, MAX_SYMBOL_NAME, text, len + 1);
       
        uintptr_t symaddr;
        int rc = symtab_addr_lookup(symname, &symaddr);
        switch (rc) {
        case ENOENT:
            printf("Symbol %s not found.\n", symname);
            return false;
        case EOVERFLOW:
            printf("Duplicate symbol %s.\n", symname);
            symtab_print_search(symname);
            return false;
        case ENOTSUP:
            printf("No symbol information available.\n");
            return false;
        }
       
        if (isaddr)
            *result = (unative_t) symaddr;
        else if (isptr)
            *result = **((unative_t **) symaddr);
        else
            *result = *((unative_t *) symaddr);
    } else {
        /* It's a number - convert it */
        *result = atoi(text);
        if (isptr)
            *result = *((unative_t *) *result);
    }
   
    return true;
}
 
/** Parse argument.
 *
 * Find start and end positions of command line argument.
 *
 * @param cmdline Command line as read from the input device.
 * @param size    Size (in bytes) of the string.
 * @param start   On entry, 'start' contains pointer to the offset
 *                of the first unprocessed character of cmdline.
 *                On successful exit, it marks beginning of the next argument.
 * @param end     Undefined on entry. On exit, 'end' is the offset of the first
 *                character behind the next argument.
 *
 * @return False on failure, true on success.
 *
 */
static bool parse_argument(const char *cmdline, size_t size, size_t *start, size_t *end)
{
    ASSERT(start != NULL);
    ASSERT(end != NULL);
   
    bool found_start = false;
    size_t offset = *start;
    size_t prev = *start;
    wchar_t ch;
   
    while ((ch = str_decode(cmdline, &offset, size)) != 0) {
        if (!found_start) {
            if (!isspace(ch)) {
                *start = prev;
                found_start = true;
            }
        } else {
            if (isspace(ch))
                break;
        }
       
        prev = offset;
    }
    *end = prev;
   
    return found_start;
}
 
/** Parse command line.
 *
 * @param cmdline Command line as read from input device.
 * @param size    Size (in bytes) of the string.
 *
 * @return Structure describing the command.
 *
 */
static cmd_info_t *parse_cmdline(const char *cmdline, size_t size)
{
    size_t start = 0;
    size_t end = 0;
    if (!parse_argument(cmdline, size, &start, &end)) {
        /* Command line did not contain alphanumeric word. */
        return NULL;
    }
    spinlock_lock(&cmd_lock);
   
    cmd_info_t *cmd = NULL;
    link_t *cur;
   
    for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {
        cmd_info_t *hlp = list_get_instance(cur, cmd_info_t, link);
        spinlock_lock(&hlp->lock);
       
        if (str_lcmp(hlp->name, cmdline + start,
            max(str_length(hlp->name),
            str_nlength(cmdline + start, (count_t) (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.
     */
   
    bool error = false;
    count_t i;
    for (i = 0; i < cmd->argc; i++) {
        start = end;
        if (!parse_argument(cmdline, size, &start, &end)) {
            printf("Too few arguments.\n");
            spinlock_unlock(&cmd->lock);
            return NULL;
        }
       
        char *buf;
        switch (cmd->argv[i].type) {
        case ARG_TYPE_STRING:
            buf = (char *) cmd->argv[i].buffer;
            str_ncpy(buf, cmd->argv[i].len, cmdline + start,
                (end - start) + 1);
            break;
        case ARG_TYPE_INT:
            if (!parse_int_arg(cmdline + start, end - start,
                &cmd->argv[i].intval))
                error = true;
            break;
        case ARG_TYPE_VAR:
            if ((start < end - 1) && (cmdline[start] == '"')) {
                if (cmdline[end - 1] == '"') {
                    buf = (char *) cmd->argv[i].buffer;
                    str_ncpy(buf, cmd->argv[i].len,
                        cmdline + start + 1,
                        (end - start) - 1);
                    cmd->argv[i].intval = (unative_t) buf;
                    cmd->argv[i].vartype = ARG_TYPE_STRING;
                } else {
                    printf("Wrong synxtax.\n");
                    error = true;
                }
            } else if (parse_int_arg(cmdline + start,
                end - start, &cmd->argv[i].intval)) {
                cmd->argv[i].vartype = ARG_TYPE_INT;
            } else {
                printf("Unrecognized variable argument.\n");
                error = true;
            }
            break;
        case ARG_TYPE_INVALID:
        default:
            printf("Invalid argument type\n");
            error = true;
            break;
        }
    }
   
    if (error) {
        spinlock_unlock(&cmd->lock);
        return NULL;
    }
   
    start = end;
    if (parse_argument(cmdline, size, &start, &end)) {
        printf("Too many arguments.\n");
        spinlock_unlock(&cmd->lock);
        return NULL;
    }
   
    spinlock_unlock(&cmd->lock);
    return cmd;
}
 
/** Kernel console prompt.
 *
 * @param prompt Kernel console prompt (e.g kconsole/panic).
 * @param msg    Message to display in the beginning.
 * @param kcon   Wait for keypress to show the prompt
 *               and never exit.
 *
 */
void kconsole(char *prompt, char *msg, bool kcon)
{
    if (!stdin) {
        LOG("No stdin for kernel console");
        return;
    }
   
    if (msg)
        printf("%s", msg);
   
    if (kcon)
        _getc(stdin);
    else
        printf("Type \"exit\" to leave the console.\n");
   
    while (true) {
        wchar_t *tmp = clever_readline((char *) prompt, stdin);
        count_t len = wstr_length(tmp);
        if (!len)
            continue;
       
        char cmdline[STR_BOUNDS(MAX_CMDLINE)];
        wstr_nstr(cmdline, tmp, STR_BOUNDS(MAX_CMDLINE));
       
        if ((!kcon) && (len == 4) && (str_lcmp(cmdline, "exit", 4) == 0))
            break;
       
        cmd_info_t *cmd_info = parse_cmdline(cmdline, STR_BOUNDS(MAX_CMDLINE));
        if (!cmd_info)
            continue;
       
        (void) cmd_info->func(cmd_info->argv);
    }
}
 
/** Kernel console managing thread.
 *
 */
void kconsole_thread(void *data)
{
    kconsole("kconsole", "Kernel console ready (press any key to activate)\n", true);
}
 
/** @}
 */
 

Rev 4224	Rev 4267
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	/** @addtogroup genericconsole	29	/** @addtogroup genericconsole
30	* @{	30	* @{
31	*/	31	*/
32		32
33	/**	33	/**
34	* @file kconsole.c	34	* @file kconsole.c
35	* @brief Kernel console.	35	* @brief Kernel console.
36	*	36	*
37	* This file contains kernel thread managing the kernel console.	37	* This file contains kernel thread managing the kernel console.
38	*	38	*
39	*/	39	*/
40		40
41	#include <console/kconsole.h>	41	#include <console/kconsole.h>
42	#include <console/console.h>	42	#include <console/console.h>
43	#include <console/chardev.h>	43	#include <console/chardev.h>
44	#include <console/cmd.h>	44	#include <console/cmd.h>
45	#include <print.h>	45	#include <print.h>
46	#include <panic.h>	46	#include <panic.h>
47	#include <arch/types.h>	47	#include <arch/types.h>
48	#include <adt/list.h>	48	#include <adt/list.h>
49	#include <arch.h>	49	#include <arch.h>
50	#include <macros.h>	50	#include <macros.h>
51	#include <debug.h>	51	#include <debug.h>
52	#include <func.h>	52	#include <func.h>
53	#include <string.h>	53	#include <string.h>
54	#include <macros.h>	54	#include <macros.h>
55	#include <sysinfo/sysinfo.h>	55	#include <sysinfo/sysinfo.h>
56	#include <ddi/device.h>	56	#include <ddi/device.h>
57	#include <symtab.h>	57	#include <symtab.h>
58	#include <errno.h>	58	#include <errno.h>
59	#include <putchar.h>	59	#include <putchar.h>
60	#include <string.h>	60	#include <string.h>
61		61
62	/** Simple kernel console.	62	/** Simple kernel console.
63	*	63	*
64	* The console is realized by kernel thread kconsole.	64	* The console is realized by kernel thread kconsole.
65	* It doesn't understand any useful command on its own,	65	* It doesn't understand any useful command on its own,
66	* but makes it possible for other kernel subsystems to	66	* but makes it possible for other kernel subsystems to
67	* register their own commands.	67	* register their own commands.
68	*/	68	*/
69		69
70	/** Locking.	70	/** Locking.
71	*	71	*
72	* There is a list of cmd_info_t structures. This list	72	* There is a list of cmd_info_t structures. This list
73	* is protected by cmd_lock spinlock. Note that specially	73	* is protected by cmd_lock spinlock. Note that specially
74	* the link elements of cmd_info_t are protected by	74	* the link elements of cmd_info_t are protected by
75	* this lock.	75	* this lock.
76	*	76	*
77	* Each cmd_info_t also has its own lock, which protects	77	* Each cmd_info_t also has its own lock, which protects
78	* all elements thereof except the link element.	78	* all elements thereof except the link element.
79	*	79	*
80	* cmd_lock must be acquired before any cmd_info lock.	80	* cmd_lock must be acquired before any cmd_info lock.
81	* When locking two cmd info structures, structure with	81	* When locking two cmd info structures, structure with
82	* lower address must be locked first.	82	* lower address must be locked first.
83	*/	83	*/
84		84
85	SPINLOCK_INITIALIZE(cmd_lock); /*< Lock protecting command list. /	85	SPINLOCK_INITIALIZE(cmd_lock); /*< Lock protecting command list. /
86	LIST_INITIALIZE(cmd_head); /*< Command list. /	86	LIST_INITIALIZE(cmd_head); /*< Command list. /
87		87
88	static wchar_t history[KCONSOLE_HISTORY][MAX_CMDLINE] = {};	88	static wchar_t history[KCONSOLE_HISTORY][MAX_CMDLINE] = {};
89	static count_t history_pos = 0;	89	static count_t history_pos = 0;
90		90
91	/** Initialize kconsole data structures	91	/** Initialize kconsole data structures
92	*	92	*
93	* This is the most basic initialization, almost no	93	* This is the most basic initialization, almost no
94	* other kernel subsystem is ready yet.	94	* other kernel subsystem is ready yet.
95	*	95	*
96	*/	96	*/
97	void kconsole_init(void)	97	void kconsole_init(void)
98	{	98	{
99	unsigned int i;	99	unsigned int i;
100		100
101	cmd_init();	101	cmd_init();
102	for (i = 0; i < KCONSOLE_HISTORY; i++)	102	for (i = 0; i < KCONSOLE_HISTORY; i++)
103	history[i][0] = 0;	103	history[i][0] = 0;
104	}	104	}
105		105
106	/** Register kconsole command.	106	/** Register kconsole command.
107	*	107	*
108	* @param cmd Structure describing the command.	108	* @param cmd Structure describing the command.
109	*	109	*
110	* @return False on failure, true on success.	110	* @return False on failure, true on success.
111	*	111	*
112	*/	112	*/
113	bool cmd_register(cmd_info_t *cmd)	113	bool cmd_register(cmd_info_t *cmd)
114	{	114	{
115	link_t *cur;	115	link_t *cur;
116		116
117	spinlock_lock(&cmd_lock);	117	spinlock_lock(&cmd_lock);
118		118
119	/*	119	/*
120	* Make sure the command is not already listed.	120	* Make sure the command is not already listed.
121	*/	121	*/
122	for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {	122	for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) {
123	cmd_info_t *hlp = list_get_instance(cur, cmd_info_t, link);	123	cmd_info_t *hlp = list_get_instance(cur, cmd_info_t, link);
124		124
125	if (hlp == cmd) {	125	if (hlp == cmd) {
126	/* The command is already there. */	126	/* The command is already there. */
127	spinlock_unlock(&cmd_lock);	127	spinlock_unlock(&cmd_lock);
128	return false;	128	return false;
129	}	129	}
130		130
131	/* Avoid deadlock. */	131	/* Avoid deadlock. */
132	if (hlp < cmd) {	132	if (hlp < cmd) {
133	spinlock_lock(&hlp->lock);	133	spinlock_lock(&hlp->lock);
134	spinlock_lock(&cmd->lock);	134	spinlock_lock(&cmd->lock);
135	} else {	135	} else {
136	spinlock_lock(&cmd->lock);	136	spinlock_lock(&cmd->lock);
137	spinlock_lock(&hlp->lock);	137	spinlock_lock(&hlp->lock);
138	}	138	}
139		139
140	if (str_cmp(hlp->name, cmd->name) == 0) {	140	if (str_cmp(hlp->name, cmd->name) == 0) {
141	/* The command is already there. */	141	/* The command is already there. */
142	spinlock_unlock(&hlp->lock);	142	spinlock_unlock(&hlp->lock);
143	spinlock_unlock(&cmd->lock);	143	spinlock_unlock(&cmd->lock);
144	spinlock_unlock(&cmd_lock);	144	spinlock_unlock(&cmd_lock);
145	return false;	145	return false;
146	}	146	}
147		147
148	spinlock_unlock(&hlp->lock);	148	spinlock_unlock(&hlp->lock);
149	spinlock_unlock(&cmd->lock);	149	spinlock_unlock(&cmd->lock);
150	}	150	}
151		151
152	/*	152	/*
153	* Now the command can be added.	153	* Now the command can be added.
154	*/	154	*/
155	list_append(&cmd->link, &cmd_head);	155	list_append(&cmd->link, &cmd_head);
156		156
157	spinlock_unlock(&cmd_lock);	157	spinlock_unlock(&cmd_lock);
158	return true;	158	return true;
159	}	159	}
160		160
161	/** Print count times a character */	161	/** Print count times a character */
162	static void print_cc(wchar_t ch, count_t count)	162	static void print_cc(wchar_t ch, count_t count)
163	{	163	{
164	count_t i;	164	count_t i;
165	for (i = 0; i < count; i++)	165	for (i = 0; i < count; i++)
166	putchar(ch);	166	putchar(ch);
167	}	167	}
168		168
169	/** Try to find a command beginning with prefix */	169	/** Try to find a command beginning with prefix */
170	static const char cmdtab_search_one(const char name, link_t **startpos)	170	static const char cmdtab_search_one(const char name, link_t **startpos)
171	{	171	{
172	count_t namelen = str_length(name);	172	count_t namelen = str_length(name);
173		173
174	spinlock_lock(&cmd_lock);	174	spinlock_lock(&cmd_lock);
175		175
176	if (*startpos == NULL)	176	if (*startpos == NULL)
177	*startpos = cmd_head.next;	177	*startpos = cmd_head.next;
178		178
179	for (; startpos != &cmd_head; startpos = (*startpos)->next) {	179	for (; startpos != &cmd_head; startpos = (*startpos)->next) {
180	cmd_info_t hlp = list_get_instance(startpos, cmd_info_t, link);	180	cmd_info_t hlp = list_get_instance(startpos, cmd_info_t, link);
181		181
182	const char *curname = hlp->name;	182	const char *curname = hlp->name;
183	if (str_length(curname) < namelen)	183	if (str_length(curname) < namelen)
184	continue;	184	continue;
185		185
186	if (str_lcmp(curname, name, namelen) == 0) {	186	if (str_lcmp(curname, name, namelen) == 0) {
187	spinlock_unlock(&cmd_lock);	187	spinlock_unlock(&cmd_lock);
188	return (curname + str_lsize(curname, namelen));	188	return (curname + str_lsize(curname, namelen));
189	}	189	}
190	}	190	}
191		191
192	spinlock_unlock(&cmd_lock);	192	spinlock_unlock(&cmd_lock);
193	return NULL;	193	return NULL;
194	}	194	}
195		195
196	/** Command completion of the commands	196	/** Command completion of the commands
197	*	197	*
198	* @param name String to match, changed to hint on exit	198	* @param name String to match, changed to hint on exit
199	* @param size Input buffer size	199	* @param size Input buffer size
200	*	200	*
201	* @return Number of found matches	201	* @return Number of found matches
202	*	202	*
203	*/	203	*/
204	static int cmdtab_compl(char *input, size_t size)	204	static int cmdtab_compl(char *input, size_t size)
205	{	205	{
206	const char *name = input;	206	const char *name = input;
207		207
208	count_t found = 0;	208	count_t found = 0;
209	link_t *pos = NULL;	209	link_t *pos = NULL;
210	const char *hint;	210	const char *hint;
211	char output[MAX_CMDLINE];	211	char output[MAX_CMDLINE];
212		212
213	output[0] = 0;	213	output[0] = 0;
214		214
215	while ((hint = cmdtab_search_one(name, &pos))) {	215	while ((hint = cmdtab_search_one(name, &pos))) {
216	if ((found == 0) \|\| (str_length(output) > str_length(hint)))	216	if ((found == 0) \|\| (str_length(output) > str_length(hint)))
217	str_ncpy(output, hint, MAX_CMDLINE);	217	str_cpy(output, MAX_CMDLINE, hint);
218		218
219	pos = pos->next;	219	pos = pos->next;
220	found++;	220	found++;
221	}	221	}
222		222
223	if ((found > 1) && (str_length(output) != 0)) {	223	if ((found > 1) && (str_length(output) != 0)) {
224	printf("\n");	224	printf("\n");
225	pos = NULL;	225	pos = NULL;
226	while ((hint = cmdtab_search_one(name, &pos))) {	226	while ((hint = cmdtab_search_one(name, &pos))) {
227	cmd_info_t *hlp = list_get_instance(pos, cmd_info_t, link);	227	cmd_info_t *hlp = list_get_instance(pos, cmd_info_t, link);
228	printf("%s (%s)\n", hlp->name, hlp->description);	228	printf("%s (%s)\n", hlp->name, hlp->description);
229	pos = pos->next;	229	pos = pos->next;
230	}	230	}
231	}	231	}
232		232
233	if (found > 0)	233	if (found > 0)
234	str_ncpy(input, output, size);	234	str_cpy(input, size, output);
235		235
236	return found;	236	return found;
237	}	237	}
238		238
239	static wchar_t clever_readline(const char prompt, indev_t *indev)	239	static wchar_t clever_readline(const char prompt, indev_t *indev)
240	{	240	{
241	printf("%s> ", prompt);	241	printf("%s> ", prompt);
242		242
243	count_t position = 0;	243	count_t position = 0;
244	wchar_t *current = history[history_pos];	244	wchar_t *current = history[history_pos];
245	current[0] = 0;	245	current[0] = 0;
246		246
247	while (true) {	247	while (true) {
248	wchar_t ch = _getc(indev);	248	wchar_t ch = _getc(indev);
249		249
250	if (ch == '\n') {	250	if (ch == '\n') {
251	/* Enter */	251	/* Enter */
252	putchar(ch);	252	putchar(ch);
253	break;	253	break;
254	}	254	}
255		255
256	if (ch == '\b') {	256	if (ch == '\b') {
257	/* Backspace */	257	/* Backspace */
258	if (position == 0)	258	if (position == 0)
259	continue;	259	continue;
260		260
261	if (wstr_remove(current, position - 1)) {	261	if (wstr_remove(current, position - 1)) {
262	position--;	262	position--;
263	putchar('\b');	263	putchar('\b');
264	printf("%ls ", current + position);	264	printf("%ls ", current + position);
265	print_cc('\b', wstr_length(current) - position + 1);	265	print_cc('\b', wstr_length(current) - position + 1);
266	continue;	266	continue;
267	}	267	}
268	}	268	}
269		269
270	if (ch == '\t') {	270	if (ch == '\t') {
271	/* Tab completion */	271	/* Tab completion */
272		272
273	/* Move to the end of the word */	273	/* Move to the end of the word */
274	for (; (current[position] != 0) && (!isspace(current[position]));	274	for (; (current[position] != 0) && (!isspace(current[position]));
275	position++)	275	position++)
276	putchar(current[position]);	276	putchar(current[position]);
277		277
278	if (position == 0)	278	if (position == 0)
279	continue;	279	continue;
280		280
281	/* Find the beginning of the word	281	/* Find the beginning of the word
282	and copy it to tmp */	282	and copy it to tmp */
283	count_t beg;	283	count_t beg;
284	for (beg = position - 1; (beg > 0) && (!isspace(current[beg]));	284	for (beg = position - 1; (beg > 0) && (!isspace(current[beg]));
285	beg--);	285	beg--);
286		286
287	if (isspace(current[beg]))	287	if (isspace(current[beg]))
288	beg++;	288	beg++;
289		289
290	char tmp[STR_BOUNDS(MAX_CMDLINE)];	290	char tmp[STR_BOUNDS(MAX_CMDLINE)];
291	wstr_nstr(tmp, current + beg, position - beg + 1);	291	wstr_nstr(tmp, current + beg, position - beg + 1);
292		292
293	int found;	293	int found;
294	if (beg == 0) {	294	if (beg == 0) {
295	/* Command completion */	295	/* Command completion */
296	found = cmdtab_compl(tmp, STR_BOUNDS(MAX_CMDLINE));	296	found = cmdtab_compl(tmp, STR_BOUNDS(MAX_CMDLINE));
297	} else {	297	} else {
298	/* Symbol completion */	298	/* Symbol completion */
299	found = symtab_compl(tmp, STR_BOUNDS(MAX_CMDLINE));	299	found = symtab_compl(tmp, STR_BOUNDS(MAX_CMDLINE));
300	}	300	}
301		301
302	if (found == 0)	302	if (found == 0)
303	continue;	303	continue;
304		304
305	size_t off = 0;	305	size_t off = 0;
306	count_t i = 0;	306	count_t i = 0;
307	while ((ch = str_decode(tmp, &off, STR_NO_LIMIT)) != 0) {	307	while ((ch = str_decode(tmp, &off, STR_NO_LIMIT)) != 0) {
308	if (!wstr_linsert(current, ch, position + i, MAX_CMDLINE))	308	if (!wstr_linsert(current, ch, position + i, MAX_CMDLINE))
309	break;	309	break;
310	i++;	310	i++;
311	}	311	}
312		312
313	if ((str_length(tmp) > 0) \|\| (found == 1)) {	313	if ((str_length(tmp) > 0) \|\| (found == 1)) {
314	/* We have a hint */	314	/* We have a hint */
315	printf("%ls", current + position);	315	printf("%ls", current + position);
316	print_cc('\b', wstr_length(current) - position);	316	print_cc('\b', wstr_length(current) - position);
317	position += str_length(tmp);	317	position += str_length(tmp);
318		318
319	if ((found == 1) && (position == wstr_length(current))) {	319	if ((found == 1) && (position == wstr_length(current))) {
320	if (wstr_linsert(current, ' ', position, MAX_CMDLINE)) {	320	if (wstr_linsert(current, ' ', position, MAX_CMDLINE)) {
321	printf("%ls", current + position);	321	printf("%ls", current + position);
322	position++;	322	position++;
323	}	323	}
324	}	324	}
325	} else {	325	} else {
326	/* No unique hint, list was printed */	326	/* No unique hint, list was printed */
327	printf("%s> ", prompt);	327	printf("%s> ", prompt);
328	printf("%ls", current);	328	printf("%ls", current);
329	position += str_length(tmp);	329	position += str_length(tmp);
330	}	330	}
331		331
332	print_cc('\b', wstr_length(current) - position);	332	print_cc('\b', wstr_length(current) - position);
333	continue;	333	continue;
334	}	334	}
335		335
336	if (ch == U_LEFT_ARROW) {	336	if (ch == U_LEFT_ARROW) {
337	/* Left */	337	/* Left */
338	if (position > 0) {	338	if (position > 0) {
339	putchar('\b');	339	putchar('\b');
340	position--;	340	position--;
341	}	341	}
342	continue;	342	continue;
343	}	343	}
344		344
345	if (ch == U_RIGHT_ARROW) {	345	if (ch == U_RIGHT_ARROW) {
346	/* Right */	346	/* Right */
347	if (position < wstr_length(current)) {	347	if (position < wstr_length(current)) {
348	putchar(current[position]);	348	putchar(current[position]);
349	position++;	349	position++;
350	}	350	}
351	continue;	351	continue;
352	}	352	}
353		353
354	if ((ch == U_UP_ARROW) \|\| (ch == U_DOWN_ARROW)) {	354	if ((ch == U_UP_ARROW) \|\| (ch == U_DOWN_ARROW)) {
355	/* Up, down */	355	/* Up, down */
356	print_cc('\b', position);	356	print_cc('\b', position);
357	print_cc(' ', wstr_length(current));	357	print_cc(' ', wstr_length(current));
358	print_cc('\b', wstr_length(current));	358	print_cc('\b', wstr_length(current));
359		359
360	if (ch == U_UP_ARROW) {	360	if (ch == U_UP_ARROW) {
361	/* Up */	361	/* Up */
362	if (history_pos == 0)	362	if (history_pos == 0)
363	history_pos = KCONSOLE_HISTORY - 1;	363	history_pos = KCONSOLE_HISTORY - 1;
364	else	364	else
365	history_pos--;	365	history_pos--;
366	} else {	366	} else {
367	/* Down */	367	/* Down */
368	history_pos++;	368	history_pos++;
369	history_pos = history_pos % KCONSOLE_HISTORY;	369	history_pos = history_pos % KCONSOLE_HISTORY;
370	}	370	}
371	current = history[history_pos];	371	current = history[history_pos];
372	printf("%ls", current);	372	printf("%ls", current);
373	position = wstr_length(current);	373	position = wstr_length(current);
374	continue;	374	continue;
375	}	375	}
376		376
377	if (ch == U_HOME_ARROW) {	377	if (ch == U_HOME_ARROW) {
378	/* Home */	378	/* Home */
379	print_cc('\b', position);	379	print_cc('\b', position);
380	position = 0;	380	position = 0;
381	continue;	381	continue;
382	}	382	}
383		383
384	if (ch == U_END_ARROW) {	384	if (ch == U_END_ARROW) {
385	/* End */	385	/* End */
386	printf("%ls", current + position);	386	printf("%ls", current + position);
387	position = wstr_length(current);	387	position = wstr_length(current);
388	continue;	388	continue;
389	}	389	}
390		390
391	if (ch == U_DELETE) {	391	if (ch == U_DELETE) {
392	/* Delete */	392	/* Delete */
393	if (position == wstr_length(current))	393	if (position == wstr_length(current))
394	continue;	394	continue;
395		395
396	if (wstr_remove(current, position)) {	396	if (wstr_remove(current, position)) {
397	printf("%ls ", current + position);	397	printf("%ls ", current + position);
398	print_cc('\b', wstr_length(current) - position + 1);	398	print_cc('\b', wstr_length(current) - position + 1);
399	}	399	}
400	continue;	400	continue;
401	}	401	}
402		402
403	if (wstr_linsert(current, ch, position, MAX_CMDLINE)) {	403	if (wstr_linsert(current, ch, position, MAX_CMDLINE)) {
404	printf("%ls", current + position);	404	printf("%ls", current + position);
405	position++;	405	position++;
406	print_cc('\b', wstr_length(current) - position);	406	print_cc('\b', wstr_length(current) - position);
407	}	407	}
408	}	408	}
409		409
410	if (wstr_length(current) > 0) {	410	if (wstr_length(current) > 0) {
411	history_pos++;	411	history_pos++;
412	history_pos = history_pos % KCONSOLE_HISTORY;	412	history_pos = history_pos % KCONSOLE_HISTORY;
413	}	413	}
414		414
415	return current;	415	return current;
416	}	416	}
417		417
418	bool kconsole_check_poll(void)	418	bool kconsole_check_poll(void)
419	{	419	{
420	return check_poll(stdin);	420	return check_poll(stdin);
421	}	421	}
422		422
423	static bool parse_int_arg(const char text, size_t len, unative_t result)	423	static bool parse_int_arg(const char text, size_t len, unative_t result)
424	{	424	{
425	bool isaddr = false;	425	bool isaddr = false;
426	bool isptr = false;	426	bool isptr = false;
427		427
428	/* If we get a name, try to find it in symbol table */	428	/* If we get a name, try to find it in symbol table */
429	if (text[0] == '&') {	429	if (text[0] == '&') {
430	isaddr = true;	430	isaddr = true;
431	text++;	431	text++;
432	len--;	432	len--;
433	} else if (text[0] == '*') {	433	} else if (text[0] == '*') {
434	isptr = true;	434	isptr = true;
435	text++;	435	text++;
436	len--;	436	len--;
437	}	437	}
438		438
439	if ((text[0] < '0') \|\| (text[0] > '9')) {	439	if ((text[0] < '0') \|\| (text[0] > '9')) {
440	char symname[MAX_SYMBOL_NAME];	440	char symname[MAX_SYMBOL_NAME];
441	str_ncpy(symname, text, min(len + 1, MAX_SYMBOL_NAME));	441	str_ncpy(symname, MAX_SYMBOL_NAME, text, len + 1);
442		442
443	uintptr_t symaddr;	443	uintptr_t symaddr;
444	int rc = symtab_addr_lookup(symname, &symaddr);	444	int rc = symtab_addr_lookup(symname, &symaddr);
445	switch (rc) {	445	switch (rc) {
446	case ENOENT:	446	case ENOENT:
447	printf("Symbol %s not found.\n", symname);	447	printf("Symbol %s not found.\n", symname);
448	return false;	448	return false;
449	case EOVERFLOW:	449	case EOVERFLOW:
450	printf("Duplicate symbol %s.\n", symname);	450	printf("Duplicate symbol %s.\n", symname);
451	symtab_print_search(symname);	451	symtab_print_search(symname);
452	return false;	452	return false;
453	case ENOTSUP:	453	case ENOTSUP:
454	printf("No symbol information available.\n");	454	printf("No symbol information available.\n");
455	return false;	455	return false;
456	}	456	}
457		457
458	if (isaddr)	458	if (isaddr)
459	*result = (unative_t) symaddr;	459	*result = (unative_t) symaddr;
460	else if (isptr)	460	else if (isptr)
461	result = ((unative_t *) symaddr);	461	result = ((unative_t *) symaddr);
462	else	462	else
463	result = ((unative_t *) symaddr);	463	result = ((unative_t *) symaddr);
464	} else {	464	} else {
465	/* It's a number - convert it */	465	/* It's a number - convert it */
466	*result = atoi(text);	466	*result = atoi(text);
467	if (isptr)	467	if (isptr)
468	result = ((unative_t ) result);	468	result = ((unative_t ) result);
469	}	469	}
470		470
471	return true;	471	return true;
472	}	472	}
473		473
474	/** Parse argument.	474	/** Parse argument.
475	*	475	*
476	* Find start and end positions of command line argument.	476	* Find start and end positions of command line argument.
477	*	477	*
478	* @param cmdline Command line as read from the input device.	478	* @param cmdline Command line as read from the input device.
479	* @param size Size (in bytes) of the string.	479	* @param size Size (in bytes) of the string.
480	* @param start On entry, 'start' contains pointer to the offset	480	* @param start On entry, 'start' contains pointer to the offset
481	* of the first unprocessed character of cmdline.	481	* of the first unprocessed character of cmdline.
482	* On successful exit, it marks beginning of the next argument.	482	* On successful exit, it marks beginning of the next argument.
483	* @param end Undefined on entry. On exit, 'end' is the offset of the first	483	* @param end Undefined on entry. On exit, 'end' is the offset of the first
484	* character behind the next argument.	484	* character behind the next argument.
485	*	485	*
486	* @return False on failure, true on success.	486	* @return False on failure, true on success.
487	*	487	*
488	*/	488	*/
489	static bool parse_argument(const char cmdline, size_t size, size_t start, size_t *end)	489	static bool parse_argument(const char cmdline, size_t size, size_t start, size_t *end)
490	{	490	{
491	ASSERT(start != NULL);	491	ASSERT(start != NULL);
492	ASSERT(end != NULL);	492	ASSERT(end != NULL);
493		493
494	bool found_start = false;	494	bool found_start = false;
495	size_t offset = *start;	495	size_t offset = *start;
496	size_t prev = *start;	496	size_t prev = *start;
497	wchar_t ch;	497	wchar_t ch;
498		498
499	while ((ch = str_decode(cmdline, &offset, size)) != 0) {	499	while ((ch = str_decode(cmdline, &offset, size)) != 0) {
500	if (!found_start) {	500	if (!found_start) {

Subversion Repositories HelenOS

(root)/trunk/kernel/generic/src/console/kconsole.c – Rev 4224 → 4267