Rev 548 | Rev 579 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 510 | jermar | 1 | /* |
| 2 | * Copyright (C) 2005 Jakub Jermar |
||
| 3 | * All rights reserved. |
||
| 4 | * |
||
| 5 | * Redistribution and use in source and binary forms, with or without |
||
| 6 | * modification, are permitted provided that the following conditions |
||
| 7 | * are met: |
||
| 8 | * |
||
| 9 | * - Redistributions of source code must retain the above copyright |
||
| 10 | * notice, this list of conditions and the following disclaimer. |
||
| 11 | * - Redistributions in binary form must reproduce the above copyright |
||
| 12 | * notice, this list of conditions and the following disclaimer in the |
||
| 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 |
||
| 15 | * derived from this software without specific prior written permission. |
||
| 16 | * |
||
| 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 |
||
| 19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
||
| 20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
||
| 21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
||
| 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 |
||
| 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 |
||
| 26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||
| 27 | */ |
||
| 28 | |||
| 518 | jermar | 29 | #include <console/kconsole.h> |
| 510 | jermar | 30 | #include <console/console.h> |
| 31 | #include <console/chardev.h> |
||
| 32 | #include <print.h> |
||
| 517 | jermar | 33 | #include <panic.h> |
| 510 | jermar | 34 | #include <typedefs.h> |
| 35 | #include <arch/types.h> |
||
| 517 | jermar | 36 | #include <list.h> |
| 37 | #include <arch.h> |
||
| 38 | #include <func.h> |
||
| 39 | #include <macros.h> |
||
| 518 | jermar | 40 | #include <debug.h> |
| 510 | jermar | 41 | |
| 517 | jermar | 42 | #define MAX_CMDLINE 256 |
| 43 | |||
| 44 | /** Simple kernel console. |
||
| 45 | * |
||
| 46 | * The console is realized by kernel thread kconsole. |
||
| 518 | jermar | 47 | * It doesn't understand any useful command on its own, |
| 48 | * but makes it possible for other kernel subsystems to |
||
| 517 | jermar | 49 | * register their own commands. |
| 50 | */ |
||
| 51 | |||
| 52 | /** Locking. |
||
| 53 | * |
||
| 54 | * There is a list of cmd_info_t structures. This list |
||
| 55 | * is protected by cmd_lock spinlock. Note that specially |
||
| 56 | * the link elements of cmd_info_t are protected by |
||
| 57 | * this lock. |
||
| 58 | * |
||
| 59 | * Each cmd_info_t also has its own lock, which protects |
||
| 60 | * all elements thereof except the link element. |
||
| 61 | * |
||
| 62 | * cmd_lock must be acquired before any cmd_info lock. |
||
| 63 | * When locking two cmd info structures, structure with |
||
| 64 | * lower address must be locked first. |
||
| 65 | */ |
||
| 66 | |||
| 67 | spinlock_t cmd_lock; /**< Lock protecting command list. */ |
||
| 68 | link_t cmd_head; /**< Command list. */ |
||
| 69 | |||
| 70 | static cmd_info_t *parse_cmdline(char *cmdline, size_t len); |
||
| 518 | jermar | 71 | static bool parse_argument(char *cmdline, size_t len, index_t *start, index_t *end); |
| 517 | jermar | 72 | |
| 518 | jermar | 73 | /** Data and methods for 'help' command. */ |
| 74 | static int cmd_help(cmd_arg_t *argv); |
||
| 517 | jermar | 75 | static cmd_info_t help_info; |
| 76 | |||
| 518 | jermar | 77 | /** Data and methods for 'description' command. */ |
| 78 | static int cmd_desc(cmd_arg_t *argv); |
||
| 79 | static void desc_help(void); |
||
| 80 | static cmd_info_t desc_info; |
||
| 81 | static char desc_buf[MAX_CMDLINE+1]; |
||
| 82 | static cmd_arg_t desc_argv = { |
||
| 83 | .type = ARG_TYPE_STRING, |
||
| 84 | .buffer = desc_buf, |
||
| 85 | .len = sizeof(desc_buf) |
||
| 86 | }; |
||
| 87 | |||
| 544 | decky | 88 | /** Data and methods for 'halt' command. */ |
| 89 | static int cmd_halt(cmd_arg_t *argv); |
||
| 90 | static cmd_info_t halt_info; |
||
| 91 | |||
| 517 | jermar | 92 | /** Initialize kconsole data structures. */ |
| 93 | void kconsole_init(void) |
||
| 94 | { |
||
| 552 | palkovsky | 95 | spinlock_initialize(&cmd_lock, "kconsole_cmd"); |
| 517 | jermar | 96 | list_initialize(&cmd_head); |
| 97 | |||
| 98 | help_info.name = "help"; |
||
| 99 | help_info.description = "List supported commands."; |
||
| 100 | help_info.func = cmd_help; |
||
| 518 | jermar | 101 | help_info.help = NULL; |
| 517 | jermar | 102 | help_info.argc = 0; |
| 103 | help_info.argv = NULL; |
||
| 518 | jermar | 104 | |
| 552 | palkovsky | 105 | spinlock_initialize(&help_info.lock, "kconsole_help"); |
| 517 | jermar | 106 | link_initialize(&help_info.link); |
| 518 | jermar | 107 | |
| 108 | if (!cmd_register(&help_info)) |
||
| 109 | panic("could not register command %s\n", help_info.name); |
||
| 110 | |||
| 111 | |||
| 112 | desc_info.name = "describe"; |
||
| 113 | desc_info.description = "Describe specified command."; |
||
| 114 | desc_info.help = desc_help; |
||
| 115 | desc_info.func = cmd_desc; |
||
| 116 | desc_info.argc = 1; |
||
| 117 | desc_info.argv = &desc_argv; |
||
| 517 | jermar | 118 | |
| 552 | palkovsky | 119 | spinlock_initialize(&desc_info.lock, "kconsole_desc"); |
| 518 | jermar | 120 | link_initialize(&desc_info.link); |
| 121 | |||
| 122 | if (!cmd_register(&desc_info)) |
||
| 123 | panic("could not register command %s\n", desc_info.name); |
||
| 544 | decky | 124 | |
| 125 | |||
| 126 | halt_info.name = "halt"; |
||
| 127 | halt_info.description = "Halt the kernel."; |
||
| 128 | halt_info.func = cmd_halt; |
||
| 129 | halt_info.help = NULL; |
||
| 130 | halt_info.argc = 0; |
||
| 131 | halt_info.argv = NULL; |
||
| 132 | |||
| 552 | palkovsky | 133 | spinlock_initialize(&halt_info.lock, "kconsole_halt"); |
| 544 | decky | 134 | link_initialize(&halt_info.link); |
| 135 | |||
| 136 | if (!cmd_register(&halt_info)) |
||
| 137 | panic("could not register command %s\n", halt_info.name); |
||
| 517 | jermar | 138 | } |
| 139 | |||
| 140 | |||
| 141 | /** Register kconsole command. |
||
| 142 | * |
||
| 143 | * @param cmd Structure describing the command. |
||
| 144 | * |
||
| 145 | * @return 0 on failure, 1 on success. |
||
| 146 | */ |
||
| 147 | int cmd_register(cmd_info_t *cmd) |
||
| 148 | { |
||
| 149 | ipl_t ipl; |
||
| 150 | link_t *cur; |
||
| 151 | |||
| 152 | ipl = interrupts_disable(); |
||
| 153 | spinlock_lock(&cmd_lock); |
||
| 154 | |||
| 155 | /* |
||
| 156 | * Make sure the command is not already listed. |
||
| 157 | */ |
||
| 158 | for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) { |
||
| 159 | cmd_info_t *hlp; |
||
| 160 | |||
| 161 | hlp = list_get_instance(cur, cmd_info_t, link); |
||
| 162 | |||
| 163 | if (hlp == cmd) { |
||
| 164 | /* The command is already there. */ |
||
| 165 | spinlock_unlock(&cmd_lock); |
||
| 166 | interrupts_restore(ipl); |
||
| 167 | return 0; |
||
| 168 | } |
||
| 169 | |||
| 170 | /* Avoid deadlock. */ |
||
| 171 | if (hlp < cmd) { |
||
| 172 | spinlock_lock(&hlp->lock); |
||
| 173 | spinlock_lock(&cmd->lock); |
||
| 174 | } else { |
||
| 175 | spinlock_lock(&cmd->lock); |
||
| 176 | spinlock_lock(&hlp->lock); |
||
| 177 | } |
||
| 178 | |||
| 518 | jermar | 179 | if ((strncmp(hlp->name, cmd->name, strlen(cmd->name)) == 0)) { |
| 517 | jermar | 180 | /* The command is already there. */ |
| 181 | spinlock_unlock(&hlp->lock); |
||
| 182 | spinlock_unlock(&cmd->lock); |
||
| 183 | spinlock_unlock(&cmd_lock); |
||
| 184 | interrupts_restore(ipl); |
||
| 185 | return 0; |
||
| 186 | } |
||
| 187 | |||
| 188 | spinlock_unlock(&hlp->lock); |
||
| 189 | spinlock_unlock(&cmd->lock); |
||
| 190 | } |
||
| 191 | |||
| 192 | /* |
||
| 193 | * Now the command can be added. |
||
| 194 | */ |
||
| 195 | list_append(&cmd->link, &cmd_head); |
||
| 196 | |||
| 197 | spinlock_unlock(&cmd_lock); |
||
| 198 | interrupts_restore(ipl); |
||
| 199 | return 1; |
||
| 200 | } |
||
| 201 | |||
| 510 | jermar | 202 | /** Kernel console managing thread. |
| 203 | * |
||
| 204 | * @param arg Not used. |
||
| 205 | */ |
||
| 206 | void kconsole(void *arg) |
||
| 207 | { |
||
| 517 | jermar | 208 | char cmdline[MAX_CMDLINE+1]; |
| 209 | cmd_info_t *cmd_info; |
||
| 210 | count_t len; |
||
| 510 | jermar | 211 | |
| 212 | if (!stdin) { |
||
| 213 | printf("%s: no stdin\n", __FUNCTION__); |
||
| 214 | return; |
||
| 215 | } |
||
| 216 | |||
| 217 | while (true) { |
||
| 218 | printf("%s> ", __FUNCTION__); |
||
| 518 | jermar | 219 | if (!(len = gets(stdin, cmdline, sizeof(cmdline)))) |
| 220 | continue; |
||
| 517 | jermar | 221 | cmdline[len] = '\0'; |
| 222 | cmd_info = parse_cmdline(cmdline, len); |
||
| 518 | jermar | 223 | if (!cmd_info) |
| 517 | jermar | 224 | continue; |
| 225 | (void) cmd_info->func(cmd_info->argv); |
||
| 510 | jermar | 226 | } |
| 227 | } |
||
| 517 | jermar | 228 | |
| 229 | /** Parse command line. |
||
| 230 | * |
||
| 231 | * @param cmdline Command line as read from input device. |
||
| 232 | * @param len Command line length. |
||
| 233 | * |
||
| 234 | * @return Structure describing the command. |
||
| 235 | */ |
||
| 236 | cmd_info_t *parse_cmdline(char *cmdline, size_t len) |
||
| 237 | { |
||
| 238 | index_t start = 0, end = 0; |
||
| 239 | cmd_info_t *cmd = NULL; |
||
| 240 | link_t *cur; |
||
| 241 | ipl_t ipl; |
||
| 242 | int i; |
||
| 243 | |||
| 518 | jermar | 244 | if (!parse_argument(cmdline, len, &start, &end)) { |
| 517 | jermar | 245 | /* Command line did not contain alphanumeric word. */ |
| 246 | return NULL; |
||
| 247 | } |
||
| 248 | |||
| 249 | ipl = interrupts_disable(); |
||
| 250 | spinlock_lock(&cmd_lock); |
||
| 251 | |||
| 252 | for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) { |
||
| 253 | cmd_info_t *hlp; |
||
| 254 | |||
| 255 | hlp = list_get_instance(cur, cmd_info_t, link); |
||
| 256 | spinlock_lock(&hlp->lock); |
||
| 257 | |||
| 518 | jermar | 258 | if (strncmp(hlp->name, &cmdline[start], (end - start) + 1) == 0) { |
| 517 | jermar | 259 | cmd = hlp; |
| 260 | break; |
||
| 261 | } |
||
| 262 | |||
| 263 | spinlock_unlock(&hlp->lock); |
||
| 264 | } |
||
| 265 | |||
| 266 | spinlock_unlock(&cmd_lock); |
||
| 267 | |||
| 268 | if (!cmd) { |
||
| 269 | /* Unknown command. */ |
||
| 518 | jermar | 270 | printf("Unknown command.\n"); |
| 517 | jermar | 271 | interrupts_restore(ipl); |
| 272 | return NULL; |
||
| 273 | } |
||
| 274 | |||
| 275 | /* cmd == hlp is locked */ |
||
| 276 | |||
| 277 | /* |
||
| 278 | * The command line must be further analyzed and |
||
| 279 | * the parameters therefrom must be matched and |
||
| 280 | * converted to those specified in the cmd info |
||
| 281 | * structure. |
||
| 282 | */ |
||
| 518 | jermar | 283 | |
| 284 | for (i = 0; i < cmd->argc; i++) { |
||
| 285 | char *buf; |
||
| 286 | start = end + 1; |
||
| 287 | if (!parse_argument(cmdline, len, &start, &end)) { |
||
| 288 | printf("Too few arguments.\n"); |
||
| 289 | spinlock_unlock(&cmd->lock); |
||
| 290 | interrupts_restore(ipl); |
||
| 291 | return NULL; |
||
| 292 | } |
||
| 293 | |||
| 294 | switch (cmd->argv[i].type) { |
||
| 295 | case ARG_TYPE_STRING: |
||
| 296 | buf = cmd->argv[i].buffer; |
||
| 297 | strncpy(buf, (const char *) &cmdline[start], min((end - start) + 1, cmd->argv[i].len - 1)); |
||
| 298 | buf[min((end - start) + 1, cmd->argv[i].len - 1)] = '\0'; |
||
| 299 | break; |
||
| 300 | case ARG_TYPE_INT: |
||
| 301 | case ARG_TYPE_INVALID: |
||
| 302 | default: |
||
| 303 | panic("invalid argument type\n"); |
||
| 304 | break; |
||
| 305 | } |
||
| 306 | } |
||
| 517 | jermar | 307 | |
| 518 | jermar | 308 | start = end + 1; |
| 309 | if (parse_argument(cmdline, len, &start, &end)) { |
||
| 310 | printf("Too many arguments.\n"); |
||
| 311 | spinlock_unlock(&cmd->lock); |
||
| 312 | interrupts_restore(ipl); |
||
| 313 | return NULL; |
||
| 314 | } |
||
| 315 | |||
| 517 | jermar | 316 | spinlock_unlock(&cmd->lock); |
| 317 | interrupts_restore(ipl); |
||
| 318 | return cmd; |
||
| 319 | } |
||
| 320 | |||
| 518 | jermar | 321 | /** Parse argument. |
| 322 | * |
||
| 323 | * Find start and end positions of command line argument. |
||
| 324 | * |
||
| 325 | * @param cmdline Command line as read from the input device. |
||
| 326 | * @param len Number of characters in cmdline. |
||
| 327 | * @param start On entry, 'start' contains pointer to the index |
||
| 328 | * of first unprocessed character of cmdline. |
||
| 329 | * On successful exit, it marks beginning of the next argument. |
||
| 330 | * @param end Undefined on entry. On exit, 'end' points to the last character |
||
| 331 | * of the next argument. |
||
| 332 | * |
||
| 333 | * @return false on failure, true on success. |
||
| 334 | */ |
||
| 335 | bool parse_argument(char *cmdline, size_t len, index_t *start, index_t *end) |
||
| 336 | { |
||
| 337 | int i; |
||
| 338 | bool found_start = false; |
||
| 339 | |||
| 340 | ASSERT(start != NULL); |
||
| 341 | ASSERT(end != NULL); |
||
| 342 | |||
| 343 | for (i = *start; i < len; i++) { |
||
| 344 | if (!found_start) { |
||
| 345 | if (is_white(cmdline[i])) |
||
| 346 | (*start)++; |
||
| 347 | else |
||
| 348 | found_start = true; |
||
| 349 | } else { |
||
| 350 | if (is_white(cmdline[i])) |
||
| 351 | break; |
||
| 352 | } |
||
| 353 | } |
||
| 354 | *end = i - 1; |
||
| 355 | |||
| 356 | return found_start; |
||
| 357 | } |
||
| 358 | |||
| 359 | |||
| 517 | jermar | 360 | /** List supported commands. |
| 361 | * |
||
| 518 | jermar | 362 | * @param argv Argument vector. |
| 517 | jermar | 363 | * |
| 364 | * @return 0 on failure, 1 on success. |
||
| 365 | */ |
||
| 518 | jermar | 366 | int cmd_help(cmd_arg_t *argv) |
| 517 | jermar | 367 | { |
| 368 | link_t *cur; |
||
| 369 | ipl_t ipl; |
||
| 370 | |||
| 371 | ipl = interrupts_disable(); |
||
| 372 | spinlock_lock(&cmd_lock); |
||
| 373 | |||
| 374 | for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) { |
||
| 375 | cmd_info_t *hlp; |
||
| 376 | |||
| 377 | hlp = list_get_instance(cur, cmd_info_t, link); |
||
| 378 | spinlock_lock(&hlp->lock); |
||
| 379 | |||
| 518 | jermar | 380 | printf("%s - %s\n", hlp->name, hlp->description); |
| 517 | jermar | 381 | |
| 382 | spinlock_unlock(&hlp->lock); |
||
| 383 | } |
||
| 384 | |||
| 385 | spinlock_unlock(&cmd_lock); |
||
| 386 | interrupts_restore(ipl); |
||
| 387 | |||
| 388 | return 1; |
||
| 389 | } |
||
| 518 | jermar | 390 | |
| 391 | /** Describe specified command. |
||
| 392 | * |
||
| 393 | * @param argv Argument vector. |
||
| 394 | * |
||
| 395 | * @return 0 on failure, 1 on success. |
||
| 396 | */ |
||
| 397 | int cmd_desc(cmd_arg_t *argv) |
||
| 398 | { |
||
| 399 | link_t *cur; |
||
| 400 | ipl_t ipl; |
||
| 401 | |||
| 402 | ipl = interrupts_disable(); |
||
| 403 | spinlock_lock(&cmd_lock); |
||
| 404 | |||
| 405 | for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) { |
||
| 406 | cmd_info_t *hlp; |
||
| 407 | |||
| 408 | hlp = list_get_instance(cur, cmd_info_t, link); |
||
| 409 | spinlock_lock(&hlp->lock); |
||
| 410 | |||
| 411 | if (strncmp(hlp->name, (const char *) argv->buffer, strlen(hlp->name)) == 0) { |
||
| 412 | printf("%s - %s\n", hlp->name, hlp->description); |
||
| 413 | if (hlp->help) |
||
| 414 | hlp->help(); |
||
| 415 | spinlock_unlock(&hlp->lock); |
||
| 416 | break; |
||
| 417 | } |
||
| 418 | |||
| 419 | spinlock_unlock(&hlp->lock); |
||
| 420 | } |
||
| 421 | |||
| 422 | spinlock_unlock(&cmd_lock); |
||
| 423 | interrupts_restore(ipl); |
||
| 424 | |||
| 425 | return 1; |
||
| 426 | } |
||
| 427 | |||
| 548 | jermar | 428 | /** Print detailed description of 'describe' command. */ |
| 429 | void desc_help(void) |
||
| 430 | { |
||
| 431 | printf("Syntax: describe command_name\n"); |
||
| 432 | } |
||
| 433 | |||
| 544 | decky | 434 | /** Halt the kernel. |
| 435 | * |
||
| 548 | jermar | 436 | * @param argv Argument vector (ignored). |
| 544 | decky | 437 | * |
| 548 | jermar | 438 | * @return 0 on failure, 1 on success (never returns). |
| 544 | decky | 439 | */ |
| 440 | int cmd_halt(cmd_arg_t *argv) |
||
| 441 | { |
||
| 442 | halt(); |
||
| 443 | return 1; |
||
| 444 | } |