Commit | Line | Data |
---|---|---|
c906108c SS |
1 | /* This file is part of the program psim. |
2 | ||
3 | Copyright (C) 1994-1997, Andrew Cagney <cagney@highland.com.au> | |
4 | ||
5 | This program is free software; you can redistribute it and/or modify | |
6 | it under the terms of the GNU General Public License as published by | |
7 | the Free Software Foundation; either version 2 of the License, or | |
8 | (at your option) any later version. | |
9 | ||
10 | This program is distributed in the hope that it will be useful, | |
11 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | GNU General Public License for more details. | |
14 | ||
15 | You should have received a copy of the GNU General Public License | |
16 | along with this program; if not, write to the Free Software | |
17 | Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
18 | ||
19 | */ | |
20 | ||
21 | ||
22 | #ifndef _PARSE_C_ | |
23 | #define _PARSE_C_ | |
24 | ||
25 | #include <stdio.h> | |
26 | #include <stdarg.h> | |
27 | ||
28 | #include "basics.h" | |
29 | ||
30 | #include "device.h" | |
31 | #include "tree.h" | |
32 | ||
33 | ||
34 | #ifdef HAVE_STDLIB_H | |
35 | #include <stdlib.h> | |
36 | #endif | |
37 | ||
38 | #ifdef HAVE_STRING_H | |
39 | #include <string.h> | |
40 | #else | |
41 | #ifdef HAVE_STRINGS_H | |
42 | #include <strings.h> | |
43 | #endif | |
44 | #endif | |
45 | ||
46 | #include <ctype.h> | |
47 | ||
59f6d9d6 | 48 | #include "libiberty.h" |
c906108c SS |
49 | |
50 | /* manipulate/lookup device names */ | |
51 | ||
52 | typedef struct _name_specifier { | |
53 | /* components in the full length name */ | |
54 | char *path; | |
55 | char *property; | |
56 | char *value; | |
57 | /* current device */ | |
58 | char *name; | |
59 | char *base; | |
60 | char *unit; | |
61 | char *args; | |
62 | /* previous device */ | |
63 | char *last_name; | |
64 | char *last_base; | |
65 | char *last_unit; | |
66 | char *last_args; | |
67 | /* work area */ | |
68 | char buf[1024]; | |
69 | } name_specifier; | |
70 | ||
71 | ||
72 | ||
73 | /* Given a device specifier, break it up into its main components: | |
74 | path (and if present) property name and property value. */ | |
75 | ||
76 | STATIC_INLINE_TREE\ | |
77 | (int) | |
78 | split_device_specifier(device *current, | |
79 | const char *device_specifier, | |
80 | name_specifier *spec) | |
81 | { | |
82 | char *chp = NULL; | |
83 | ||
84 | /* expand any leading alias if present */ | |
85 | if (current != NULL | |
86 | && *device_specifier != '\0' | |
87 | && *device_specifier != '.' | |
88 | && *device_specifier != '/') { | |
89 | device *aliases = tree_find_device(current, "/aliases"); | |
90 | char alias[32]; | |
91 | int len = 0; | |
92 | while (device_specifier[len] != '\0' | |
93 | && device_specifier[len] != '/' | |
94 | && device_specifier[len] != ':' | |
95 | && !isspace(device_specifier[len])) { | |
96 | alias[len] = device_specifier[len]; | |
97 | len++; | |
98 | if (len >= sizeof(alias)) | |
99 | error("split_device_specifier: buffer overflow"); | |
100 | } | |
101 | alias[len] = '\0'; | |
102 | if (aliases != NULL | |
103 | && device_find_property(aliases, alias)) { | |
104 | strcpy(spec->buf, device_find_string_property(aliases, alias)); | |
105 | strcat(spec->buf, device_specifier + len); | |
106 | } | |
107 | else { | |
108 | strcpy(spec->buf, device_specifier); | |
109 | } | |
110 | } | |
111 | else { | |
112 | strcpy(spec->buf, device_specifier); | |
113 | } | |
114 | ||
115 | /* check no overflow */ | |
116 | if (strlen(spec->buf) >= sizeof(spec->buf)) | |
117 | error("split_device_specifier: buffer overflow\n"); | |
118 | ||
119 | /* strip leading spaces */ | |
120 | chp = spec->buf; | |
121 | while (*chp != '\0' && isspace(*chp)) | |
122 | chp++; | |
123 | if (*chp == '\0') | |
124 | return 0; | |
125 | ||
126 | /* find the path and terminate it with null */ | |
127 | spec->path = chp; | |
128 | while (*chp != '\0' && !isspace(*chp)) | |
129 | chp++; | |
130 | if (*chp != '\0') { | |
131 | *chp = '\0'; | |
132 | chp++; | |
133 | } | |
134 | ||
135 | /* and any value */ | |
136 | while (*chp != '\0' && isspace(*chp)) | |
137 | chp++; | |
138 | spec->value = chp; | |
139 | ||
140 | /* now go back and chop the property off of the path */ | |
141 | if (spec->value[0] == '\0') { | |
142 | spec->property = NULL; /*not a property*/ | |
143 | spec->value = NULL; | |
144 | } | |
145 | else if (spec->value[0] == '>' | |
146 | || spec->value[0] == '<') { | |
147 | /* an interrupt spec */ | |
148 | spec->property = NULL; | |
149 | } | |
150 | else { | |
151 | chp = strrchr(spec->path, '/'); | |
152 | if (chp == NULL) { | |
153 | spec->property = spec->path; | |
154 | spec->path = strchr(spec->property, '\0'); | |
155 | } | |
156 | else { | |
157 | *chp = '\0'; | |
158 | spec->property = chp+1; | |
159 | } | |
160 | } | |
161 | ||
162 | /* and mark the rest as invalid */ | |
163 | spec->name = NULL; | |
164 | spec->base = NULL; | |
165 | spec->unit = NULL; | |
166 | spec->args = NULL; | |
167 | spec->last_name = NULL; | |
168 | spec->last_base = NULL; | |
169 | spec->last_unit = NULL; | |
170 | spec->last_args = NULL; | |
171 | ||
172 | return 1; | |
173 | } | |
174 | ||
175 | ||
176 | /* given a device specifier break it up into its main components - | |
177 | path and property name - assuming that the last `device' is a | |
178 | property name. */ | |
179 | ||
180 | STATIC_INLINE_DEVICE\ | |
181 | (int) | |
182 | split_property_specifier(device *current, | |
183 | const char *property_specifier, | |
184 | name_specifier *spec) | |
185 | { | |
186 | if (split_device_specifier(current, property_specifier, spec)) { | |
187 | if (spec->property == NULL) { | |
188 | /* force the last name to be a property name */ | |
189 | char *chp = strrchr(spec->path, '/'); | |
190 | if (chp == NULL) { | |
191 | spec->property = spec->path; | |
192 | spec->path = strrchr(spec->property, '\0');; | |
193 | } | |
194 | else { | |
195 | *chp = '\0'; | |
196 | spec->property = chp+1; | |
197 | } | |
198 | } | |
199 | return 1; | |
200 | } | |
201 | else | |
202 | return 0; | |
203 | } | |
204 | ||
205 | ||
206 | /* device the next device name and split it up, return 0 when no more | |
207 | names to device */ | |
208 | ||
209 | STATIC_INLINE_TREE\ | |
210 | (int) | |
211 | split_device_name(name_specifier *spec) | |
212 | { | |
213 | char *chp; | |
214 | /* remember what came before */ | |
215 | spec->last_name = spec->name; | |
216 | spec->last_base = spec->base; | |
217 | spec->last_unit = spec->unit; | |
218 | spec->last_args = spec->args; | |
219 | /* finished? */ | |
220 | if (spec->path[0] == '\0') { | |
221 | spec->name = NULL; | |
222 | spec->base = NULL; | |
223 | spec->unit = NULL; | |
224 | spec->args = NULL; | |
225 | return 0; | |
226 | } | |
227 | /* break the current device spec from the path */ | |
228 | spec->name = spec->path; | |
229 | chp = strchr(spec->name, '/'); | |
230 | if (chp == NULL) | |
231 | spec->path = strchr(spec->name, '\0'); | |
232 | else { | |
233 | spec->path = chp+1; | |
234 | *chp = '\0'; | |
235 | } | |
236 | /* break out the base */ | |
237 | if (spec->name[0] == '(') { | |
238 | chp = strchr(spec->name, ')'); | |
239 | if (chp == NULL) { | |
240 | spec->base = spec->name; | |
241 | } | |
242 | else { | |
243 | *chp = '\0'; | |
244 | spec->base = spec->name + 1; | |
245 | spec->name = chp + 1; | |
246 | } | |
247 | } | |
248 | else { | |
249 | spec->base = spec->name; | |
250 | } | |
251 | /* now break out the unit */ | |
252 | chp = strchr(spec->name, '@'); | |
253 | if (chp == NULL) { | |
254 | spec->unit = NULL; | |
255 | chp = spec->name; | |
256 | } | |
257 | else { | |
258 | *chp = '\0'; | |
259 | chp += 1; | |
260 | spec->unit = chp; | |
261 | } | |
262 | /* finally any args */ | |
263 | chp = strchr(chp, ':'); | |
264 | if (chp == NULL) | |
265 | spec->args = NULL; | |
266 | else { | |
267 | *chp = '\0'; | |
268 | spec->args = chp+1; | |
269 | } | |
270 | return 1; | |
271 | } | |
272 | ||
273 | ||
274 | /* device the value, returning the next non-space token */ | |
275 | ||
276 | STATIC_INLINE_TREE\ | |
277 | (char *) | |
278 | split_value(name_specifier *spec) | |
279 | { | |
280 | char *token; | |
281 | if (spec->value == NULL) | |
282 | return NULL; | |
283 | /* skip leading white space */ | |
284 | while (isspace(spec->value[0])) | |
285 | spec->value++; | |
286 | if (spec->value[0] == '\0') { | |
287 | spec->value = NULL; | |
288 | return NULL; | |
289 | } | |
290 | token = spec->value; | |
291 | /* find trailing space */ | |
292 | while (spec->value[0] != '\0' && !isspace(spec->value[0])) | |
293 | spec->value++; | |
294 | /* chop this value out */ | |
295 | if (spec->value[0] != '\0') { | |
296 | spec->value[0] = '\0'; | |
297 | spec->value++; | |
298 | } | |
299 | return token; | |
300 | } | |
301 | ||
302 | ||
303 | ||
304 | /* traverse the path specified by spec starting at current */ | |
305 | ||
306 | STATIC_INLINE_TREE\ | |
307 | (device *) | |
308 | split_find_device(device *current, | |
309 | name_specifier *spec) | |
310 | { | |
311 | /* strip off (and process) any leading ., .., ./ and / */ | |
312 | while (1) { | |
313 | if (strncmp(spec->path, "/", strlen("/")) == 0) { | |
314 | /* cd /... */ | |
315 | while (current != NULL && device_parent(current) != NULL) | |
316 | current = device_parent(current); | |
317 | spec->path += strlen("/"); | |
318 | } | |
319 | else if (strncmp(spec->path, "./", strlen("./")) == 0) { | |
320 | /* cd ./... */ | |
321 | current = current; | |
322 | spec->path += strlen("./"); | |
323 | } | |
324 | else if (strncmp(spec->path, "../", strlen("../")) == 0) { | |
325 | /* cd ../... */ | |
326 | if (current != NULL && device_parent(current) != NULL) | |
327 | current = device_parent(current); | |
328 | spec->path += strlen("../"); | |
329 | } | |
330 | else if (strcmp(spec->path, ".") == 0) { | |
331 | /* cd . */ | |
332 | current = current; | |
333 | spec->path += strlen("."); | |
334 | } | |
335 | else if (strcmp(spec->path, "..") == 0) { | |
336 | /* cd . */ | |
337 | if (current != NULL && device_parent(current) != NULL) | |
338 | current = device_parent(current); | |
339 | spec->path += strlen(".."); | |
340 | } | |
341 | else | |
342 | break; | |
343 | } | |
344 | ||
345 | /* now go through the path proper */ | |
346 | ||
347 | if (current == NULL) { | |
348 | split_device_name(spec); | |
349 | return NULL; | |
350 | } | |
351 | ||
352 | while (split_device_name(spec)) { | |
353 | device *child; | |
354 | for (child = device_child(current); | |
355 | child != NULL; child = device_sibling(child)) { | |
356 | if (strcmp(spec->name, device_name(child)) == 0) { | |
357 | if (spec->unit == NULL) | |
358 | break; | |
359 | else { | |
360 | device_unit phys; | |
361 | device_decode_unit(current, spec->unit, &phys); | |
362 | if (memcmp(&phys, device_unit_address(child), | |
363 | sizeof(device_unit)) == 0) | |
364 | break; | |
365 | } | |
366 | } | |
367 | } | |
368 | if (child == NULL) | |
369 | return current; /* search failed */ | |
370 | current = child; | |
371 | } | |
372 | ||
373 | return current; | |
374 | } | |
375 | ||
376 | ||
377 | STATIC_INLINE_TREE\ | |
378 | (device *) | |
379 | split_fill_path(device *current, | |
380 | const char *device_specifier, | |
381 | name_specifier *spec) | |
382 | { | |
383 | /* break it up */ | |
384 | if (!split_device_specifier(current, device_specifier, spec)) | |
385 | device_error(current, "error parsing %s\n", device_specifier); | |
386 | ||
387 | /* fill our tree with its contents */ | |
388 | current = split_find_device(current, spec); | |
389 | ||
390 | /* add any additional devices as needed */ | |
391 | if (spec->name != NULL) { | |
392 | do { | |
393 | current = device_create(current, spec->base, spec->name, | |
394 | spec->unit, spec->args); | |
395 | } while (split_device_name(spec)); | |
396 | } | |
397 | ||
398 | return current; | |
399 | } | |
400 | ||
401 | ||
402 | INLINE_TREE\ | |
403 | (void) | |
404 | tree_init(device *root, | |
405 | psim *system) | |
406 | { | |
407 | TRACE(trace_device_tree, ("tree_init(root=0x%lx, system=0x%lx)\n", | |
408 | (long)root, | |
409 | (long)system)); | |
410 | /* remove the old, rebuild the new */ | |
411 | tree_traverse(root, device_clean, NULL, system); | |
412 | tree_traverse(root, device_init_static_properties, NULL, system); | |
413 | tree_traverse(root, device_init_address, NULL, system); | |
414 | tree_traverse(root, device_init_runtime_properties, NULL, system); | |
415 | tree_traverse(root, device_init_data, NULL, system); | |
416 | } | |
417 | ||
418 | ||
419 | \f | |
420 | /* <non-white-space> */ | |
421 | ||
422 | STATIC_INLINE_TREE\ | |
423 | (const char *) | |
424 | skip_token(const char *chp) | |
425 | { | |
426 | while (!isspace(*chp) && *chp != '\0') | |
427 | chp++; | |
428 | while (isspace(*chp) && *chp != '\0') | |
429 | chp++; | |
430 | return chp; | |
431 | } | |
432 | ||
433 | ||
434 | /* count the number of entries */ | |
435 | ||
436 | STATIC_INLINE_TREE\ | |
437 | (int) | |
438 | count_entries(device *current, | |
439 | const char *property_name, | |
440 | const char *property_value, | |
441 | int modulo) | |
442 | { | |
443 | const char *chp = property_value; | |
444 | int nr_entries = 0; | |
445 | while (*chp != '\0') { | |
446 | nr_entries += 1; | |
447 | chp = skip_token(chp); | |
448 | } | |
449 | if ((nr_entries % modulo) != 0) { | |
450 | device_error(current, "incorrect number of entries for %s property %s, should be multiple of %d", | |
451 | property_name, property_value, modulo); | |
452 | } | |
453 | return nr_entries / modulo; | |
454 | } | |
455 | ||
456 | ||
457 | ||
458 | /* parse: <address> ::= <token> ; device dependant */ | |
459 | ||
460 | STATIC_INLINE_TREE\ | |
461 | (const char *) | |
462 | parse_address(device *current, | |
463 | device *bus, | |
464 | const char *chp, | |
465 | device_unit *address) | |
466 | { | |
bebd2b35 | 467 | ASSERT(device_nr_address_cells(bus) > 0); |
c906108c SS |
468 | if (device_decode_unit(bus, chp, address) < 0) |
469 | device_error(current, "invalid unit address in %s", chp); | |
470 | return skip_token(chp); | |
471 | } | |
472 | ||
473 | ||
474 | /* parse: <size> ::= <number> { "," <number> } ; */ | |
475 | ||
476 | STATIC_INLINE_TREE\ | |
477 | (const char *) | |
478 | parse_size(device *current, | |
479 | device *bus, | |
480 | const char *chp, | |
481 | device_unit *size) | |
482 | { | |
483 | int i; | |
484 | int nr; | |
485 | const char *curr = chp; | |
486 | memset(size, 0, sizeof(*size)); | |
487 | /* parse the numeric list */ | |
488 | size->nr_cells = device_nr_size_cells(bus); | |
489 | nr = 0; | |
bebd2b35 | 490 | ASSERT(size->nr_cells > 0); |
c906108c SS |
491 | while (1) { |
492 | char *next; | |
493 | size->cells[nr] = strtoul(curr, &next, 0); | |
494 | if (curr == next) | |
495 | device_error(current, "Problem parsing <size> %s", chp); | |
496 | nr += 1; | |
497 | if (next[0] != ',') | |
498 | break; | |
499 | if (nr == size->nr_cells) | |
500 | device_error(current, "Too many values in <size> %s", chp); | |
501 | curr = next + 1; | |
502 | } | |
503 | ASSERT(nr > 0 && nr <= size->nr_cells); | |
504 | /* right align the numbers */ | |
505 | for (i = 1; i <= size->nr_cells; i++) { | |
506 | if (i <= nr) | |
507 | size->cells[size->nr_cells - i] = size->cells[nr - i]; | |
508 | else | |
509 | size->cells[size->nr_cells - i] = 0; | |
510 | } | |
511 | return skip_token(chp); | |
512 | } | |
513 | ||
514 | ||
515 | /* parse: <reg> ::= { <address> <size> } ; */ | |
516 | ||
517 | STATIC_INLINE_TREE\ | |
518 | (void) | |
519 | parse_reg_property(device *current, | |
520 | const char *property_name, | |
521 | const char *property_value) | |
522 | { | |
523 | int nr_regs; | |
524 | int reg_nr; | |
525 | reg_property_spec *regs; | |
526 | const char *chp; | |
bebd2b35 | 527 | device *bus = device_parent(current); |
c906108c SS |
528 | |
529 | /* determine the number of reg entries by counting tokens */ | |
bebd2b35 AC |
530 | nr_regs = count_entries(current, property_name, property_value, |
531 | 1 + (device_nr_size_cells(bus) > 0)); | |
c906108c SS |
532 | |
533 | /* create working space */ | |
534 | regs = zalloc(nr_regs * sizeof(*regs)); | |
535 | ||
536 | /* fill it in */ | |
537 | chp = property_value; | |
538 | for (reg_nr = 0; reg_nr < nr_regs; reg_nr++) { | |
bebd2b35 AC |
539 | chp = parse_address(current, bus, chp, ®s[reg_nr].address); |
540 | if (device_nr_size_cells(bus) > 0) | |
541 | chp = parse_size(current, bus, chp, ®s[reg_nr].size); | |
542 | else | |
170cd118 | 543 | memset(®s[reg_nr].size, 0, sizeof (®s[reg_nr].size)); |
c906108c SS |
544 | } |
545 | ||
546 | /* create it */ | |
547 | device_add_reg_array_property(current, property_name, | |
548 | regs, nr_regs); | |
549 | ||
d79fe0d6 | 550 | free(regs); |
c906108c SS |
551 | } |
552 | ||
553 | ||
554 | /* { <child-address> <parent-address> <child-size> }* */ | |
555 | ||
556 | STATIC_INLINE_TREE\ | |
557 | (void) | |
558 | parse_ranges_property(device *current, | |
559 | const char *property_name, | |
560 | const char *property_value) | |
561 | { | |
562 | int nr_ranges; | |
563 | int range_nr; | |
564 | range_property_spec *ranges; | |
565 | const char *chp; | |
566 | ||
567 | /* determine the number of ranges specified */ | |
568 | nr_ranges = count_entries(current, property_name, property_value, 3); | |
569 | ||
570 | /* create a property of that size */ | |
571 | ranges = zalloc(nr_ranges * sizeof(*ranges)); | |
572 | ||
573 | /* fill it in */ | |
574 | chp = property_value; | |
575 | for (range_nr = 0; range_nr < nr_ranges; range_nr++) { | |
576 | chp = parse_address(current, current, | |
577 | chp, &ranges[range_nr].child_address); | |
578 | chp = parse_address(current, device_parent(current), | |
579 | chp, &ranges[range_nr].parent_address); | |
580 | chp = parse_size(current, current, | |
581 | chp, &ranges[range_nr].size); | |
582 | } | |
583 | ||
584 | /* create it */ | |
585 | device_add_range_array_property(current, property_name, ranges, nr_ranges); | |
586 | ||
d79fe0d6 | 587 | free(ranges); |
c906108c SS |
588 | } |
589 | ||
590 | ||
591 | /* <integer> ... */ | |
592 | ||
593 | STATIC_INLINE_TREE\ | |
594 | (void) | |
595 | parse_integer_property(device *current, | |
596 | const char *property_name, | |
597 | const char *property_value) | |
598 | { | |
599 | int nr_entries; | |
600 | unsigned_cell words[1024]; | |
601 | /* integer or integer array? */ | |
602 | nr_entries = 0; | |
603 | while (1) { | |
604 | char *end; | |
605 | words[nr_entries] = strtoul(property_value, &end, 0); | |
606 | if (property_value == end) | |
607 | break; | |
608 | nr_entries += 1; | |
609 | if (nr_entries * sizeof(words[0]) >= sizeof(words)) | |
610 | device_error(current, "buffer overflow"); | |
611 | property_value = end; | |
612 | } | |
613 | if (nr_entries == 0) | |
614 | device_error(current, "error parsing integer property %s (%s)", | |
615 | property_name, property_value); | |
616 | else if (nr_entries == 1) | |
617 | device_add_integer_property(current, property_name, words[0]); | |
618 | else { | |
619 | int i; | |
620 | for (i = 0; i < nr_entries; i++) { | |
621 | H2BE(words[i]); | |
622 | } | |
ea5c7021 | 623 | /* perhaps integer array property is better */ |
c906108c SS |
624 | device_add_array_property(current, property_name, words, |
625 | sizeof(words[0]) * nr_entries); | |
626 | } | |
627 | } | |
628 | ||
59f6d9d6 MM |
629 | /* PROPERTY_VALUE is a raw property value. Quote it as required by |
630 | parse_string_property. It is the caller's responsibility to free | |
631 | the memory returned. */ | |
632 | ||
633 | EXTERN_TREE\ | |
634 | (char *) | |
635 | tree_quote_property(const char *property_value) | |
636 | { | |
637 | char *p; | |
638 | char *ret; | |
639 | const char *chp; | |
640 | int quotees; | |
641 | ||
642 | /* Count characters needing quotes in PROPERTY_VALUE. */ | |
643 | quotees = 0; | |
644 | for (chp = property_value; *chp; ++chp) | |
645 | if (*chp == '\\' || *chp == '"') | |
646 | ++quotees; | |
647 | ||
648 | ret = (char *) xmalloc (strlen (property_value) | |
649 | + 2 /* quotes */ | |
650 | + quotees | |
651 | + 1 /* terminator */); | |
652 | ||
653 | p = ret; | |
654 | /* Add the opening quote. */ | |
655 | *p++ = '"'; | |
656 | /* Copy the value. */ | |
657 | for (chp = property_value; *chp; ++chp) | |
658 | if (*chp == '\\' || *chp == '"') | |
659 | { | |
660 | /* Quote this character. */ | |
661 | *p++ = '\\'; | |
662 | *p++ = *chp; | |
663 | } | |
664 | else | |
665 | *p++ = *chp; | |
666 | /* Add the closing quote. */ | |
667 | *p++ = '"'; | |
668 | /* Terminate the string. */ | |
669 | *p++ = '\0'; | |
670 | ||
671 | return ret; | |
672 | } | |
c906108c SS |
673 | |
674 | /* <string> ... */ | |
675 | ||
676 | STATIC_INLINE_TREE\ | |
677 | (void) | |
678 | parse_string_property(device *current, | |
679 | const char *property_name, | |
680 | const char *property_value) | |
681 | { | |
682 | char **strings; | |
683 | const char *chp; | |
684 | int nr_strings; | |
685 | int approx_nr_strings; | |
686 | ||
687 | /* get an estimate as to the number of strings by counting double | |
688 | quotes */ | |
689 | approx_nr_strings = 2; | |
690 | for (chp = property_value; *chp; chp++) { | |
691 | if (*chp == '"') | |
692 | approx_nr_strings++; | |
693 | } | |
694 | approx_nr_strings = (approx_nr_strings) / 2; | |
695 | ||
696 | /* create a string buffer for that many (plus a null) */ | |
697 | strings = (char**)zalloc((approx_nr_strings + 1) * sizeof(char*)); | |
698 | ||
699 | /* now find all the strings */ | |
700 | chp = property_value; | |
701 | nr_strings = 0; | |
702 | while (1) { | |
703 | ||
704 | /* skip leading space */ | |
705 | while (*chp != '\0' && isspace(*chp)) | |
706 | chp += 1; | |
707 | if (*chp == '\0') | |
708 | break; | |
709 | ||
710 | /* copy it in */ | |
711 | if (*chp == '"') { | |
712 | /* a quoted string - watch for '\' et.al. */ | |
713 | /* estimate the size and allocate space for it */ | |
714 | int pos; | |
715 | chp++; | |
716 | pos = 0; | |
717 | while (chp[pos] != '\0' && chp[pos] != '"') { | |
718 | if (chp[pos] == '\\' && chp[pos+1] != '\0') | |
719 | pos += 2; | |
720 | else | |
721 | pos += 1; | |
722 | } | |
723 | strings[nr_strings] = zalloc(pos + 1); | |
724 | /* copy the string over */ | |
725 | pos = 0; | |
726 | while (*chp != '\0' && *chp != '"') { | |
727 | if (*chp == '\\' && *(chp+1) != '\0') { | |
728 | strings[nr_strings][pos] = *(chp+1); | |
729 | chp += 2; | |
730 | pos++; | |
731 | } | |
732 | else { | |
733 | strings[nr_strings][pos] = *chp; | |
734 | chp += 1; | |
735 | pos++; | |
736 | } | |
737 | } | |
738 | if (*chp != '\0') | |
739 | chp++; | |
740 | strings[nr_strings][pos] = '\0'; | |
741 | } | |
742 | else { | |
743 | /* copy over a single unquoted token */ | |
744 | int len = 0; | |
745 | while (chp[len] != '\0' && !isspace(chp[len])) | |
746 | len++; | |
747 | strings[nr_strings] = zalloc(len + 1); | |
748 | strncpy(strings[nr_strings], chp, len); | |
749 | strings[nr_strings][len] = '\0'; | |
750 | chp += len; | |
751 | } | |
752 | nr_strings++; | |
753 | if (nr_strings > approx_nr_strings) | |
754 | device_error(current, "String property %s badly formatted", | |
755 | property_name); | |
756 | } | |
757 | ASSERT(strings[nr_strings] == NULL); /* from zalloc */ | |
758 | ||
759 | /* install it */ | |
760 | if (nr_strings == 0) | |
761 | device_add_string_property(current, property_name, ""); | |
762 | else if (nr_strings == 1) | |
763 | device_add_string_property(current, property_name, strings[0]); | |
764 | else { | |
765 | const char **specs = (const char**)strings; /* stop a bogus error */ | |
766 | device_add_string_array_property(current, property_name, | |
767 | specs, nr_strings); | |
768 | } | |
769 | ||
770 | /* flush the created string */ | |
771 | while (nr_strings > 0) { | |
772 | nr_strings--; | |
d79fe0d6 | 773 | free(strings[nr_strings]); |
c906108c | 774 | } |
d79fe0d6 | 775 | free(strings); |
c906108c SS |
776 | } |
777 | ||
778 | ||
779 | /* <path-to-ihandle-device> */ | |
780 | ||
781 | STATIC_INLINE_TREE\ | |
782 | (void) | |
783 | parse_ihandle_property(device *current, | |
784 | const char *property, | |
785 | const char *value) | |
786 | { | |
787 | ihandle_runtime_property_spec ihandle; | |
788 | ||
789 | /* pass the full path */ | |
790 | ihandle.full_path = value; | |
791 | ||
792 | /* save this ready for the ihandle create */ | |
793 | device_add_ihandle_runtime_property(current, property, | |
794 | &ihandle); | |
795 | } | |
796 | ||
797 | ||
798 | ||
799 | EXTERN_TREE\ | |
800 | (device *) | |
801 | tree_parse(device *current, | |
802 | const char *fmt, | |
803 | ...) | |
804 | { | |
805 | char device_specifier[1024]; | |
806 | name_specifier spec; | |
807 | ||
808 | /* format the path */ | |
809 | { | |
810 | va_list ap; | |
811 | va_start(ap, fmt); | |
812 | vsprintf(device_specifier, fmt, ap); | |
813 | va_end(ap); | |
814 | if (strlen(device_specifier) >= sizeof(device_specifier)) | |
815 | error("device_tree_add_deviced: buffer overflow\n"); | |
816 | } | |
817 | ||
818 | /* construct the tree down to the final device */ | |
819 | current = split_fill_path(current, device_specifier, &spec); | |
820 | ||
821 | /* is there an interrupt spec */ | |
822 | if (spec.property == NULL | |
823 | && spec.value != NULL) { | |
824 | char *op = split_value(&spec); | |
825 | switch (op[0]) { | |
826 | case '>': | |
827 | { | |
828 | char *my_port_name = split_value(&spec); | |
829 | int my_port; | |
830 | char *dest_port_name = split_value(&spec); | |
831 | int dest_port; | |
832 | name_specifier dest_spec; | |
833 | char *dest_device_name = split_value(&spec); | |
834 | device *dest; | |
835 | /* find my name */ | |
836 | my_port = device_interrupt_decode(current, my_port_name, | |
837 | output_port); | |
838 | /* find the dest device and port */ | |
839 | dest = split_fill_path(current, dest_device_name, &dest_spec); | |
840 | dest_port = device_interrupt_decode(dest, dest_port_name, | |
841 | input_port); | |
842 | /* connect the two */ | |
843 | device_interrupt_attach(current, | |
844 | my_port, | |
845 | dest, | |
846 | dest_port, | |
847 | permenant_object); | |
848 | } | |
849 | break; | |
850 | default: | |
851 | device_error(current, "unreconised interrupt spec %s\n", spec.value); | |
852 | break; | |
853 | } | |
854 | } | |
855 | ||
856 | /* is there a property */ | |
857 | if (spec.property != NULL) { | |
858 | if (strcmp(spec.value, "true") == 0) | |
859 | device_add_boolean_property(current, spec.property, 1); | |
860 | else if (strcmp(spec.value, "false") == 0) | |
861 | device_add_boolean_property(current, spec.property, 0); | |
862 | else { | |
863 | const device_property *property; | |
864 | switch (spec.value[0]) { | |
865 | case '*': | |
866 | parse_ihandle_property(current, spec.property, spec.value + 1); | |
867 | break; | |
868 | case '[': | |
869 | { | |
870 | unsigned8 words[1024]; | |
871 | char *curr = spec.value + 1; | |
872 | int nr_words = 0; | |
873 | while (1) { | |
874 | char *next; | |
875 | words[nr_words] = H2BE_1(strtoul(curr, &next, 0)); | |
876 | if (curr == next) | |
877 | break; | |
878 | curr = next; | |
879 | nr_words += 1; | |
880 | } | |
881 | device_add_array_property(current, spec.property, | |
882 | words, sizeof(words[0]) * nr_words); | |
883 | } | |
884 | break; | |
885 | case '"': | |
886 | parse_string_property(current, spec.property, spec.value); | |
887 | break; | |
888 | case '!': | |
889 | spec.value++; | |
890 | property = tree_find_property(current, spec.value); | |
891 | if (property == NULL) | |
892 | device_error(current, "property %s not found\n", spec.value); | |
893 | device_add_duplicate_property(current, | |
894 | spec.property, | |
895 | property); | |
896 | break; | |
897 | default: | |
898 | if (strcmp(spec.property, "reg") == 0 | |
899 | || strcmp(spec.property, "assigned-addresses") == 0 | |
900 | || strcmp(spec.property, "alternate-reg") == 0){ | |
901 | parse_reg_property(current, spec.property, spec.value); | |
902 | } | |
903 | else if (strcmp(spec.property, "ranges") == 0) { | |
904 | parse_ranges_property(current, spec.property, spec.value); | |
905 | } | |
906 | else if (isdigit(spec.value[0]) | |
907 | || (spec.value[0] == '-' && isdigit(spec.value[1])) | |
908 | || (spec.value[0] == '+' && isdigit(spec.value[1]))) { | |
909 | parse_integer_property(current, spec.property, spec.value); | |
910 | } | |
911 | else | |
912 | parse_string_property(current, spec.property, spec.value); | |
913 | break; | |
914 | } | |
915 | } | |
916 | } | |
917 | return current; | |
918 | } | |
919 | ||
920 | ||
921 | INLINE_TREE\ | |
922 | (void) | |
923 | tree_traverse(device *root, | |
924 | tree_traverse_function *prefix, | |
925 | tree_traverse_function *postfix, | |
926 | void *data) | |
927 | { | |
928 | device *child; | |
929 | if (prefix != NULL) | |
930 | prefix(root, data); | |
931 | for (child = device_child(root); | |
932 | child != NULL; | |
933 | child = device_sibling(child)) { | |
934 | tree_traverse(child, prefix, postfix, data); | |
935 | } | |
936 | if (postfix != NULL) | |
937 | postfix(root, data); | |
938 | } | |
939 | ||
940 | ||
941 | STATIC_INLINE_TREE\ | |
942 | (void) | |
943 | print_address(device *bus, | |
944 | const device_unit *phys) | |
945 | { | |
946 | char unit[32]; | |
947 | device_encode_unit(bus, phys, unit, sizeof(unit)); | |
948 | printf_filtered(" %s", unit); | |
949 | } | |
950 | ||
951 | STATIC_INLINE_TREE\ | |
952 | (void) | |
953 | print_size(device *bus, | |
954 | const device_unit *size) | |
955 | { | |
956 | int i; | |
957 | for (i = 0; i < size->nr_cells; i++) | |
958 | if (size->cells[i] != 0) | |
959 | break; | |
960 | if (i < size->nr_cells) { | |
961 | printf_filtered(" 0x%lx", (unsigned long)size->cells[i]); | |
962 | i++; | |
963 | for (; i < size->nr_cells; i++) | |
964 | printf_filtered(",0x%lx", (unsigned long)size->cells[i]); | |
965 | } | |
966 | else | |
967 | printf_filtered(" 0"); | |
968 | } | |
969 | ||
970 | STATIC_INLINE_TREE\ | |
971 | (void) | |
972 | print_reg_property(device *me, | |
973 | const device_property *property) | |
974 | { | |
975 | int reg_nr; | |
976 | reg_property_spec reg; | |
977 | for (reg_nr = 0; | |
978 | device_find_reg_array_property(me, property->name, reg_nr, ®); | |
979 | reg_nr++) { | |
980 | print_address(device_parent(me), ®.address); | |
981 | print_size(me, ®.size); | |
982 | } | |
983 | } | |
984 | ||
985 | STATIC_INLINE_TREE\ | |
986 | (void) | |
987 | print_ranges_property(device *me, | |
988 | const device_property *property) | |
989 | { | |
990 | int range_nr; | |
991 | range_property_spec range; | |
992 | for (range_nr = 0; | |
993 | device_find_range_array_property(me, property->name, range_nr, &range); | |
994 | range_nr++) { | |
995 | print_address(me, &range.child_address); | |
996 | print_address(device_parent(me), &range.parent_address); | |
997 | print_size(me, &range.size); | |
998 | } | |
999 | } | |
1000 | ||
1001 | STATIC_INLINE_TREE\ | |
1002 | (void) | |
1003 | print_string(const char *string) | |
1004 | { | |
1005 | printf_filtered(" \""); | |
1006 | while (*string != '\0') { | |
1007 | switch (*string) { | |
1008 | case '"': | |
1009 | printf_filtered("\\\""); | |
1010 | break; | |
1011 | case '\\': | |
1012 | printf_filtered("\\\\"); | |
1013 | break; | |
1014 | default: | |
1015 | printf_filtered("%c", *string); | |
1016 | break; | |
1017 | } | |
1018 | string++; | |
1019 | } | |
1020 | printf_filtered("\""); | |
1021 | } | |
1022 | ||
1023 | STATIC_INLINE_TREE\ | |
1024 | (void) | |
1025 | print_string_array_property(device *me, | |
1026 | const device_property *property) | |
1027 | { | |
1028 | int nr; | |
1029 | string_property_spec string; | |
1030 | for (nr = 0; | |
1031 | device_find_string_array_property(me, property->name, nr, &string); | |
1032 | nr++) { | |
1033 | print_string(string); | |
1034 | } | |
1035 | } | |
1036 | ||
1037 | STATIC_INLINE_TREE\ | |
1038 | (void) | |
1039 | print_properties(device *me) | |
1040 | { | |
1041 | const device_property *property; | |
1042 | for (property = device_find_property(me, NULL); | |
1043 | property != NULL; | |
1044 | property = device_next_property(property)) { | |
1045 | printf_filtered("%s/%s", device_path(me), property->name); | |
1046 | if (property->original != NULL) { | |
1047 | printf_filtered(" !"); | |
1048 | printf_filtered("%s/%s", | |
1049 | device_path(property->original->owner), | |
1050 | property->original->name); | |
1051 | } | |
1052 | else { | |
1053 | switch (property->type) { | |
1054 | case array_property: | |
1055 | if ((property->sizeof_array % sizeof(signed_cell)) == 0) { | |
1056 | unsigned_cell *w = (unsigned_cell*)property->array; | |
1057 | int cell_nr; | |
1058 | for (cell_nr = 0; | |
1059 | cell_nr < (property->sizeof_array / sizeof(unsigned_cell)); | |
1060 | cell_nr++) { | |
1061 | printf_filtered(" 0x%lx", (unsigned long)BE2H_cell(w[cell_nr])); | |
1062 | } | |
1063 | } | |
1064 | else { | |
1065 | unsigned8 *w = (unsigned8*)property->array; | |
1066 | printf_filtered(" ["); | |
1067 | while ((char*)w - (char*)property->array < property->sizeof_array) { | |
1068 | printf_filtered(" 0x%2x", BE2H_1(*w)); | |
1069 | w++; | |
1070 | } | |
1071 | } | |
1072 | break; | |
1073 | case boolean_property: | |
1074 | { | |
1075 | int b = device_find_boolean_property(me, property->name); | |
1076 | printf_filtered(" %s", b ? "true" : "false"); | |
1077 | } | |
1078 | break; | |
1079 | case ihandle_property: | |
1080 | { | |
1081 | if (property->array != NULL) { | |
1082 | device_instance *instance = device_find_ihandle_property(me, property->name); | |
1083 | printf_filtered(" *%s", device_instance_path(instance)); | |
1084 | } | |
1085 | else { | |
1086 | /* not yet initialized, ask the device for the path */ | |
1087 | ihandle_runtime_property_spec spec; | |
1088 | device_find_ihandle_runtime_property(me, property->name, &spec); | |
1089 | printf_filtered(" *%s", spec.full_path); | |
1090 | } | |
1091 | } | |
1092 | break; | |
1093 | case integer_property: | |
1094 | { | |
1095 | unsigned_word w = device_find_integer_property(me, property->name); | |
1096 | printf_filtered(" 0x%lx", (unsigned long)w); | |
1097 | } | |
1098 | break; | |
1099 | case range_array_property: | |
1100 | print_ranges_property(me, property); | |
1101 | break; | |
1102 | case reg_array_property: | |
1103 | print_reg_property(me, property); | |
1104 | break; | |
1105 | case string_property: | |
1106 | { | |
1107 | const char *s = device_find_string_property(me, property->name); | |
1108 | print_string(s); | |
1109 | } | |
1110 | break; | |
1111 | case string_array_property: | |
1112 | print_string_array_property(me, property); | |
1113 | break; | |
1114 | } | |
1115 | } | |
1116 | printf_filtered("\n"); | |
1117 | } | |
1118 | } | |
1119 | ||
1120 | STATIC_INLINE_TREE\ | |
1121 | (void) | |
1122 | print_interrupts(device *me, | |
1123 | int my_port, | |
1124 | device *dest, | |
1125 | int dest_port, | |
1126 | void *ignore_or_null) | |
1127 | { | |
1128 | char src[32]; | |
1129 | char dst[32]; | |
1130 | device_interrupt_encode(me, my_port, src, sizeof(src), output_port); | |
1131 | device_interrupt_encode(dest, dest_port, dst, sizeof(dst), input_port); | |
1132 | printf_filtered("%s > %s %s %s\n", | |
1133 | device_path(me), | |
1134 | src, dst, | |
1135 | device_path(dest)); | |
1136 | } | |
1137 | ||
1138 | STATIC_INLINE_TREE\ | |
1139 | (void) | |
1140 | print_device(device *me, | |
1141 | void *ignore_or_null) | |
1142 | { | |
1143 | printf_filtered("%s\n", device_path(me)); | |
1144 | print_properties(me); | |
1145 | device_interrupt_traverse(me, print_interrupts, NULL); | |
1146 | } | |
1147 | ||
1148 | INLINE_TREE\ | |
1149 | (void) | |
1150 | tree_print(device *root) | |
1151 | { | |
1152 | tree_traverse(root, | |
1153 | print_device, NULL, | |
1154 | NULL); | |
1155 | } | |
1156 | ||
1157 | ||
1158 | INLINE_TREE\ | |
1159 | (void) | |
1160 | tree_usage(int verbose) | |
1161 | { | |
1162 | if (verbose == 1) { | |
1163 | printf_filtered("\n"); | |
1164 | printf_filtered("A device/property specifier has the form:\n"); | |
1165 | printf_filtered("\n"); | |
1166 | printf_filtered(" /path/to/a/device [ property-value ]\n"); | |
1167 | printf_filtered("\n"); | |
1168 | printf_filtered("and a possible device is\n"); | |
1169 | printf_filtered("\n"); | |
1170 | } | |
1171 | if (verbose > 1) { | |
1172 | printf_filtered("\n"); | |
1173 | printf_filtered("A device/property specifier (<spec>) has the format:\n"); | |
1174 | printf_filtered("\n"); | |
1175 | printf_filtered(" <spec> ::= <path> [ <value> ] ;\n"); | |
1176 | printf_filtered(" <path> ::= { <prefix> } { <node> \"/\" } <node> ;\n"); | |
1177 | printf_filtered(" <prefix> ::= ( | \"/\" | \"../\" | \"./\" ) ;\n"); | |
1178 | printf_filtered(" <node> ::= <name> [ \"@\" <unit> ] [ \":\" <args> ] ;\n"); | |
1179 | printf_filtered(" <unit> ::= <number> { \",\" <number> } ;\n"); | |
1180 | printf_filtered("\n"); | |
1181 | printf_filtered("Where:\n"); | |
1182 | printf_filtered("\n"); | |
1183 | printf_filtered(" <name> is the name of a device (list below)\n"); | |
1184 | printf_filtered(" <unit> is the unit-address relative to the parent bus\n"); | |
1185 | printf_filtered(" <args> additional arguments used when creating the device\n"); | |
1186 | printf_filtered(" <value> ::= ( <number> # integer property\n"); | |
1187 | printf_filtered(" | \"[\" { <number> } # array property (byte)\n"); | |
1188 | printf_filtered(" | \"{\" { <number> } # array property (cell)\n"); | |
1189 | printf_filtered(" | [ \"true\" | \"false\" ] # boolean property\n"); | |
1190 | printf_filtered(" | \"*\" <path> # ihandle property\n"); | |
1191 | printf_filtered(" | \"!\" <path> # copy property\n"); | |
1192 | printf_filtered(" | \">\" [ <number> ] <path> # attach interrupt\n"); | |
1193 | printf_filtered(" | \"<\" <path> # attach child interrupt\n"); | |
1194 | printf_filtered(" | \"\\\"\" <text> # string property\n"); | |
1195 | printf_filtered(" | <text> # string property\n"); | |
1196 | printf_filtered(" ) ;\n"); | |
1197 | printf_filtered("\n"); | |
1198 | printf_filtered("And the following are valid device names:\n"); | |
1199 | printf_filtered("\n"); | |
1200 | } | |
1201 | } | |
1202 | ||
1203 | ||
1204 | ||
1205 | INLINE_TREE\ | |
1206 | (device_instance *) | |
1207 | tree_instance(device *root, | |
1208 | const char *device_specifier) | |
1209 | { | |
1210 | /* find the device node */ | |
1211 | device *me; | |
1212 | name_specifier spec; | |
1213 | if (!split_device_specifier(root, device_specifier, &spec)) | |
1214 | return NULL; | |
1215 | me = split_find_device(root, &spec); | |
1216 | if (spec.name != NULL) | |
1217 | return NULL; | |
1218 | /* create the instance */ | |
1219 | return device_create_instance(me, device_specifier, spec.last_args); | |
1220 | } | |
1221 | ||
1222 | ||
1223 | INLINE_TREE\ | |
1224 | (device *) | |
1225 | tree_find_device(device *root, | |
1226 | const char *path_to_device) | |
1227 | { | |
1228 | device *node; | |
1229 | name_specifier spec; | |
1230 | ||
1231 | /* parse the path */ | |
1232 | split_device_specifier(root, path_to_device, &spec); | |
1233 | if (spec.value != NULL) | |
1234 | return NULL; /* something wierd */ | |
1235 | ||
1236 | /* now find it */ | |
1237 | node = split_find_device(root, &spec); | |
1238 | if (spec.name != NULL) | |
1239 | return NULL; /* not a leaf */ | |
1240 | ||
1241 | return node; | |
1242 | } | |
1243 | ||
1244 | ||
1245 | INLINE_TREE\ | |
1246 | (const device_property *) | |
1247 | tree_find_property(device *root, | |
1248 | const char *path_to_property) | |
1249 | { | |
1250 | name_specifier spec; | |
1251 | if (!split_property_specifier(root, path_to_property, &spec)) | |
1252 | device_error(root, "Invalid property path %s", path_to_property); | |
1253 | root = split_find_device(root, &spec); | |
1254 | return device_find_property(root, spec.property); | |
1255 | } | |
1256 | ||
1257 | INLINE_TREE\ | |
1258 | (int) | |
1259 | tree_find_boolean_property(device *root, | |
1260 | const char *path_to_property) | |
1261 | { | |
1262 | name_specifier spec; | |
1263 | if (!split_property_specifier(root, path_to_property, &spec)) | |
1264 | device_error(root, "Invalid property path %s", path_to_property); | |
1265 | root = split_find_device(root, &spec); | |
1266 | return device_find_boolean_property(root, spec.property); | |
1267 | } | |
1268 | ||
1269 | INLINE_TREE\ | |
1270 | (signed_cell) | |
1271 | tree_find_integer_property(device *root, | |
1272 | const char *path_to_property) | |
1273 | { | |
1274 | name_specifier spec; | |
1275 | if (!split_property_specifier(root, path_to_property, &spec)) | |
1276 | device_error(root, "Invalid property path %s", path_to_property); | |
1277 | root = split_find_device(root, &spec); | |
1278 | return device_find_integer_property(root, spec.property); | |
1279 | } | |
1280 | ||
1281 | INLINE_TREE\ | |
1282 | (device_instance *) | |
1283 | tree_find_ihandle_property(device *root, | |
1284 | const char *path_to_property) | |
1285 | { | |
1286 | name_specifier spec; | |
1287 | if (!split_property_specifier(root, path_to_property, &spec)) | |
1288 | device_error(root, "Invalid property path %s", path_to_property); | |
1289 | root = split_find_device(root, &spec); | |
1290 | return device_find_ihandle_property(root, spec.property); | |
1291 | } | |
1292 | ||
1293 | INLINE_TREE\ | |
1294 | (const char *) | |
1295 | tree_find_string_property(device *root, | |
1296 | const char *path_to_property) | |
1297 | { | |
1298 | name_specifier spec; | |
1299 | if (!split_property_specifier(root, path_to_property, &spec)) | |
1300 | device_error(root, "Invalid property path %s", path_to_property); | |
1301 | root = split_find_device(root, &spec); | |
1302 | return device_find_string_property(root, spec.property); | |
1303 | } | |
1304 | ||
1305 | ||
1306 | #endif /* _PARSE_C_ */ |