123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158 |
- #include "boot.h"
- static inline int myisspace(u8 c)
- {
- return c <= ' ';
- }
- int __cmdline_find_option(unsigned long cmdline_ptr, const char *option, char *buffer, int bufsize)
- {
- addr_t cptr;
- char c;
- int len = -1;
- const char *opptr = NULL;
- char *bufptr = buffer;
- enum {
- st_wordstart,
- st_wordcmp,
- st_wordskip,
- st_bufcpy
- } state = st_wordstart;
- if (!cmdline_ptr)
- return -1;
- cptr = cmdline_ptr & 0xf;
- set_fs(cmdline_ptr >> 4);
- while (cptr < 0x10000 && (c = rdfs8(cptr++))) {
- switch (state) {
- case st_wordstart:
- if (myisspace(c))
- break;
-
- state = st_wordcmp;
- opptr = option;
-
- case st_wordcmp:
- if (c == '=' && !*opptr) {
- len = 0;
- bufptr = buffer;
- state = st_bufcpy;
- } else if (myisspace(c)) {
- state = st_wordstart;
- } else if (c != *opptr++) {
- state = st_wordskip;
- }
- break;
- case st_wordskip:
- if (myisspace(c))
- state = st_wordstart;
- break;
- case st_bufcpy:
- if (myisspace(c)) {
- state = st_wordstart;
- } else {
- if (len < bufsize-1)
- *bufptr++ = c;
- len++;
- }
- break;
- }
- }
- if (bufsize)
- *bufptr = '\0';
- return len;
- }
- int __cmdline_find_option_bool(unsigned long cmdline_ptr, const char *option)
- {
- addr_t cptr;
- char c;
- int pos = 0, wstart = 0;
- const char *opptr = NULL;
- enum {
- st_wordstart,
- st_wordcmp,
- st_wordskip,
- } state = st_wordstart;
- if (!cmdline_ptr)
- return -1;
- cptr = cmdline_ptr & 0xf;
- set_fs(cmdline_ptr >> 4);
- while (cptr < 0x10000) {
- c = rdfs8(cptr++);
- pos++;
- switch (state) {
- case st_wordstart:
- if (!c)
- return 0;
- else if (myisspace(c))
- break;
- state = st_wordcmp;
- opptr = option;
- wstart = pos;
-
- case st_wordcmp:
- if (!*opptr)
- if (!c || myisspace(c))
- return wstart;
- else
- state = st_wordskip;
- else if (!c)
- return 0;
- else if (c != *opptr++)
- state = st_wordskip;
- break;
- case st_wordskip:
- if (!c)
- return 0;
- else if (myisspace(c))
- state = st_wordstart;
- break;
- }
- }
- return 0;
- }
|