Rev 552 | Rev 582 | 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 | spinlock_lock(&cmd_lock); |
||
| 153 | |||
| 154 | /* |
||
| 155 | * Make sure the command is not already listed. |
||
| 156 | */ |
||
| 157 | for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) { |
||
| 158 | cmd_info_t *hlp; |
||
| 159 | |||
| 160 | hlp = list_get_instance(cur, cmd_info_t, link); |
||
| 161 | |||
| 162 | if (hlp == cmd) { |
||
| 163 | /* The command is already there. */ |
||
| 164 | spinlock_unlock(&cmd_lock); |
||
| 165 | return 0; |
||
| 166 | } |
||
| 167 | |||
| 168 | /* Avoid deadlock. */ |
||
| 169 | if (hlp < cmd) { |
||
| 170 | spinlock_lock(&hlp->lock); |
||
| 171 | spinlock_lock(&cmd->lock); |
||
| 172 | } else { |
||
| 173 | spinlock_lock(&cmd->lock); |
||
| 174 | spinlock_lock(&hlp->lock); |
||
| 175 | } |
||
| 176 | |||
| 518 | jermar | 177 | if ((strncmp(hlp->name, cmd->name, strlen(cmd->name)) == 0)) { |
| 517 | jermar | 178 | /* The command is already there. */ |
| 179 | spinlock_unlock(&hlp->lock); |
||
| 180 | spinlock_unlock(&cmd->lock); |
||
| 181 | spinlock_unlock(&cmd_lock); |
||
| 182 | return 0; |
||
| 183 | } |
||
| 184 | |||
| 185 | spinlock_unlock(&hlp->lock); |
||
| 186 | spinlock_unlock(&cmd->lock); |
||
| 187 | } |
||
| 188 | |||
| 189 | /* |
||
| 190 | * Now the command can be added. |
||
| 191 | */ |
||
| 192 | list_append(&cmd->link, &cmd_head); |
||
| 193 | |||
| 194 | spinlock_unlock(&cmd_lock); |
||
| 195 | return 1; |
||
| 196 | } |
||
| 197 | |||
| 510 | jermar | 198 | /** Kernel console managing thread. |
| 199 | * |
||
| 200 | * @param arg Not used. |
||
| 201 | */ |
||
| 202 | void kconsole(void *arg) |
||
| 203 | { |
||
| 517 | jermar | 204 | char cmdline[MAX_CMDLINE+1]; |
| 205 | cmd_info_t *cmd_info; |
||
| 206 | count_t len; |
||
| 510 | jermar | 207 | |
| 208 | if (!stdin) { |
||
| 209 | printf("%s: no stdin\n", __FUNCTION__); |
||
| 210 | return; |
||
| 211 | } |
||
| 212 | |||
| 213 | while (true) { |
||
| 214 | printf("%s> ", __FUNCTION__); |
||
| 518 | jermar | 215 | if (!(len = gets(stdin, cmdline, sizeof(cmdline)))) |
| 216 | continue; |
||
| 517 | jermar | 217 | cmdline[len] = '\0'; |
| 218 | cmd_info = parse_cmdline(cmdline, len); |
||
| 518 | jermar | 219 | if (!cmd_info) |
| 517 | jermar | 220 | continue; |
| 221 | (void) cmd_info->func(cmd_info->argv); |
||
| 510 | jermar | 222 | } |
| 223 | } |
||
| 517 | jermar | 224 | |
| 225 | /** Parse command line. |
||
| 226 | * |
||
| 227 | * @param cmdline Command line as read from input device. |
||
| 228 | * @param len Command line length. |
||
| 229 | * |
||
| 230 | * @return Structure describing the command. |
||
| 231 | */ |
||
| 232 | cmd_info_t *parse_cmdline(char *cmdline, size_t len) |
||
| 233 | { |
||
| 234 | index_t start = 0, end = 0; |
||
| 235 | cmd_info_t *cmd = NULL; |
||
| 236 | link_t *cur; |
||
| 237 | ipl_t ipl; |
||
| 238 | int i; |
||
| 239 | |||
| 518 | jermar | 240 | if (!parse_argument(cmdline, len, &start, &end)) { |
| 517 | jermar | 241 | /* Command line did not contain alphanumeric word. */ |
| 242 | return NULL; |
||
| 243 | } |
||
| 244 | |||
| 245 | spinlock_lock(&cmd_lock); |
||
| 246 | |||
| 247 | for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) { |
||
| 248 | cmd_info_t *hlp; |
||
| 249 | |||
| 250 | hlp = list_get_instance(cur, cmd_info_t, link); |
||
| 251 | spinlock_lock(&hlp->lock); |
||
| 252 | |||
| 518 | jermar | 253 | if (strncmp(hlp->name, &cmdline[start], (end - start) + 1) == 0) { |
| 517 | jermar | 254 | cmd = hlp; |
| 255 | break; |
||
| 256 | } |
||
| 257 | |||
| 258 | spinlock_unlock(&hlp->lock); |
||
| 259 | } |
||
| 260 | |||
| 261 | spinlock_unlock(&cmd_lock); |
||
| 262 | |||
| 263 | if (!cmd) { |
||
| 264 | /* Unknown command. */ |
||
| 518 | jermar | 265 | printf("Unknown command.\n"); |
| 517 | jermar | 266 | return NULL; |
| 267 | } |
||
| 268 | |||
| 269 | /* cmd == hlp is locked */ |
||
| 270 | |||
| 271 | /* |
||
| 272 | * The command line must be further analyzed and |
||
| 273 | * the parameters therefrom must be matched and |
||
| 274 | * converted to those specified in the cmd info |
||
| 275 | * structure. |
||
| 276 | */ |
||
| 518 | jermar | 277 | |
| 278 | for (i = 0; i < cmd->argc; i++) { |
||
| 279 | char *buf; |
||
| 280 | start = end + 1; |
||
| 281 | if (!parse_argument(cmdline, len, &start, &end)) { |
||
| 282 | printf("Too few arguments.\n"); |
||
| 283 | spinlock_unlock(&cmd->lock); |
||
| 284 | return NULL; |
||
| 285 | } |
||
| 286 | |||
| 287 | switch (cmd->argv[i].type) { |
||
| 288 | case ARG_TYPE_STRING: |
||
| 289 | buf = cmd->argv[i].buffer; |
||
| 290 | strncpy(buf, (const char *) &cmdline[start], min((end - start) + 1, cmd->argv[i].len - 1)); |
||
| 291 | buf[min((end - start) + 1, cmd->argv[i].len - 1)] = '\0'; |
||
| 292 | break; |
||
| 293 | case ARG_TYPE_INT: |
||
| 294 | case ARG_TYPE_INVALID: |
||
| 295 | default: |
||
| 296 | panic("invalid argument type\n"); |
||
| 297 | break; |
||
| 298 | } |
||
| 299 | } |
||
| 517 | jermar | 300 | |
| 518 | jermar | 301 | start = end + 1; |
| 302 | if (parse_argument(cmdline, len, &start, &end)) { |
||
| 303 | printf("Too many arguments.\n"); |
||
| 304 | spinlock_unlock(&cmd->lock); |
||
| 305 | return NULL; |
||
| 306 | } |
||
| 307 | |||
| 517 | jermar | 308 | spinlock_unlock(&cmd->lock); |
| 309 | return cmd; |
||
| 310 | } |
||
| 311 | |||
| 518 | jermar | 312 | /** Parse argument. |
| 313 | * |
||
| 314 | * Find start and end positions of command line argument. |
||
| 315 | * |
||
| 316 | * @param cmdline Command line as read from the input device. |
||
| 317 | * @param len Number of characters in cmdline. |
||
| 318 | * @param start On entry, 'start' contains pointer to the index |
||
| 319 | * of first unprocessed character of cmdline. |
||
| 320 | * On successful exit, it marks beginning of the next argument. |
||
| 321 | * @param end Undefined on entry. On exit, 'end' points to the last character |
||
| 322 | * of the next argument. |
||
| 323 | * |
||
| 324 | * @return false on failure, true on success. |
||
| 325 | */ |
||
| 326 | bool parse_argument(char *cmdline, size_t len, index_t *start, index_t *end) |
||
| 327 | { |
||
| 328 | int i; |
||
| 329 | bool found_start = false; |
||
| 330 | |||
| 331 | ASSERT(start != NULL); |
||
| 332 | ASSERT(end != NULL); |
||
| 333 | |||
| 334 | for (i = *start; i < len; i++) { |
||
| 335 | if (!found_start) { |
||
| 336 | if (is_white(cmdline[i])) |
||
| 337 | (*start)++; |
||
| 338 | else |
||
| 339 | found_start = true; |
||
| 340 | } else { |
||
| 341 | if (is_white(cmdline[i])) |
||
| 342 | break; |
||
| 343 | } |
||
| 344 | } |
||
| 345 | *end = i - 1; |
||
| 346 | |||
| 347 | return found_start; |
||
| 348 | } |
||
| 349 | |||
| 350 | |||
| 517 | jermar | 351 | /** List supported commands. |
| 352 | * |
||
| 518 | jermar | 353 | * @param argv Argument vector. |
| 517 | jermar | 354 | * |
| 355 | * @return 0 on failure, 1 on success. |
||
| 356 | */ |
||
| 518 | jermar | 357 | int cmd_help(cmd_arg_t *argv) |
| 517 | jermar | 358 | { |
| 359 | link_t *cur; |
||
| 360 | ipl_t ipl; |
||
| 361 | |||
| 362 | spinlock_lock(&cmd_lock); |
||
| 363 | |||
| 364 | for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) { |
||
| 365 | cmd_info_t *hlp; |
||
| 366 | |||
| 367 | hlp = list_get_instance(cur, cmd_info_t, link); |
||
| 368 | spinlock_lock(&hlp->lock); |
||
| 369 | |||
| 518 | jermar | 370 | printf("%s - %s\n", hlp->name, hlp->description); |
| 517 | jermar | 371 | |
| 372 | spinlock_unlock(&hlp->lock); |
||
| 373 | } |
||
| 374 | |||
| 375 | spinlock_unlock(&cmd_lock); |
||
| 376 | |||
| 377 | return 1; |
||
| 378 | } |
||
| 518 | jermar | 379 | |
| 380 | /** Describe specified command. |
||
| 381 | * |
||
| 382 | * @param argv Argument vector. |
||
| 383 | * |
||
| 384 | * @return 0 on failure, 1 on success. |
||
| 385 | */ |
||
| 386 | int cmd_desc(cmd_arg_t *argv) |
||
| 387 | { |
||
| 388 | link_t *cur; |
||
| 389 | ipl_t ipl; |
||
| 390 | |||
| 391 | spinlock_lock(&cmd_lock); |
||
| 392 | |||
| 393 | for (cur = cmd_head.next; cur != &cmd_head; cur = cur->next) { |
||
| 394 | cmd_info_t *hlp; |
||
| 395 | |||
| 396 | hlp = list_get_instance(cur, cmd_info_t, link); |
||
| 397 | spinlock_lock(&hlp->lock); |
||
| 398 | |||
| 399 | if (strncmp(hlp->name, (const char *) argv->buffer, strlen(hlp->name)) == 0) { |
||
| 400 | printf("%s - %s\n", hlp->name, hlp->description); |
||
| 401 | if (hlp->help) |
||
| 402 | hlp->help(); |
||
| 403 | spinlock_unlock(&hlp->lock); |
||
| 404 | break; |
||
| 405 | } |
||
| 406 | |||
| 407 | spinlock_unlock(&hlp->lock); |
||
| 408 | } |
||
| 409 | |||
| 410 | spinlock_unlock(&cmd_lock); |
||
| 411 | |||
| 412 | return 1; |
||
| 413 | } |
||
| 414 | |||
| 548 | jermar | 415 | /** Print detailed description of 'describe' command. */ |
| 416 | void desc_help(void) |
||
| 417 | { |
||
| 418 | printf("Syntax: describe command_name\n"); |
||
| 419 | } |
||
| 420 | |||
| 544 | decky | 421 | /** Halt the kernel. |
| 422 | * |
||
| 548 | jermar | 423 | * @param argv Argument vector (ignored). |
| 544 | decky | 424 | * |
| 548 | jermar | 425 | * @return 0 on failure, 1 on success (never returns). |
| 544 | decky | 426 | */ |
| 427 | int cmd_halt(cmd_arg_t *argv) |
||
| 428 | { |
||
| 429 | halt(); |
||
| 430 | return 1; |
||
| 431 | } |