1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include "boot.h"
16
17static inline int myisspace(u8 c)
18{
19 return c <= ' ';
20}
21
22
23
24
25
26
27
28
29
30int __cmdline_find_option(u32 cmdline_ptr, const char *option, char *buffer, int bufsize)
31{
32 addr_t cptr;
33 char c;
34 int len = -1;
35 const char *opptr = NULL;
36 char *bufptr = buffer;
37 enum {
38 st_wordstart,
39 st_wordcmp,
40 st_wordskip,
41 st_bufcpy
42 } state = st_wordstart;
43
44 if (!cmdline_ptr || cmdline_ptr >= 0x100000)
45 return -1;
46
47 cptr = cmdline_ptr & 0xf;
48 set_fs(cmdline_ptr >> 4);
49
50 while (cptr < 0x10000 && (c = rdfs8(cptr++))) {
51 switch (state) {
52 case st_wordstart:
53 if (myisspace(c))
54 break;
55
56
57 state = st_wordcmp;
58 opptr = option;
59
60
61 case st_wordcmp:
62 if (c == '=' && !*opptr) {
63 len = 0;
64 bufptr = buffer;
65 state = st_bufcpy;
66 } else if (myisspace(c)) {
67 state = st_wordstart;
68 } else if (c != *opptr++) {
69 state = st_wordskip;
70 }
71 break;
72
73 case st_wordskip:
74 if (myisspace(c))
75 state = st_wordstart;
76 break;
77
78 case st_bufcpy:
79 if (myisspace(c)) {
80 state = st_wordstart;
81 } else {
82 if (len < bufsize-1)
83 *bufptr++ = c;
84 len++;
85 }
86 break;
87 }
88 }
89
90 if (bufsize)
91 *bufptr = '\0';
92
93 return len;
94}
95
96
97
98
99
100
101
102int __cmdline_find_option_bool(u32 cmdline_ptr, const char *option)
103{
104 addr_t cptr;
105 char c;
106 int pos = 0, wstart = 0;
107 const char *opptr = NULL;
108 enum {
109 st_wordstart,
110 st_wordcmp,
111 st_wordskip,
112 } state = st_wordstart;
113
114 if (!cmdline_ptr || cmdline_ptr >= 0x100000)
115 return -1;
116
117 cptr = cmdline_ptr & 0xf;
118 set_fs(cmdline_ptr >> 4);
119
120 while (cptr < 0x10000) {
121 c = rdfs8(cptr++);
122 pos++;
123
124 switch (state) {
125 case st_wordstart:
126 if (!c)
127 return 0;
128 else if (myisspace(c))
129 break;
130
131 state = st_wordcmp;
132 opptr = option;
133 wstart = pos;
134
135
136 case st_wordcmp:
137 if (!*opptr)
138 if (!c || myisspace(c))
139 return wstart;
140 else
141 state = st_wordskip;
142 else if (!c)
143 return 0;
144 else if (c != *opptr++)
145 state = st_wordskip;
146 break;
147
148 case st_wordskip:
149 if (!c)
150 return 0;
151 else if (myisspace(c))
152 state = st_wordstart;
153 break;
154 }
155 }
156
157 return 0;
158}
159