|  | /*  This file is part of the program psim. | 
|  |  | 
|  | Copyright (C) 1994-1997, Andrew Cagney <cagney@highland.com.au> | 
|  |  | 
|  | This program is free software; you can redistribute it and/or modify | 
|  | it under the terms of the GNU General Public License as published by | 
|  | the Free Software Foundation; either version 3 of the License, or | 
|  | (at your option) any later version. | 
|  |  | 
|  | This program is distributed in the hope that it will be useful, | 
|  | but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | GNU General Public License for more details. | 
|  |  | 
|  | You should have received a copy of the GNU General Public License | 
|  | along with this program; if not, see <http://www.gnu.org/licenses/>. | 
|  |  | 
|  | */ | 
|  |  | 
|  |  | 
|  | #ifndef _PARSE_C_ | 
|  | #define _PARSE_C_ | 
|  |  | 
|  | #include <stdio.h> | 
|  | #include <stdarg.h> | 
|  |  | 
|  | #include "basics.h" | 
|  |  | 
|  | #include "device.h" | 
|  | #include "tree.h" | 
|  |  | 
|  | #include <stdlib.h> | 
|  | #include <string.h> | 
|  | #include <ctype.h> | 
|  |  | 
|  | #include "libiberty.h" | 
|  |  | 
|  | /* manipulate/lookup device names */ | 
|  |  | 
|  | typedef struct _name_specifier { | 
|  | /* components in the full length name */ | 
|  | char *path; | 
|  | char *property; | 
|  | char *value; | 
|  | /* current device */ | 
|  | char *name; | 
|  | char *base; | 
|  | char *unit; | 
|  | char *args; | 
|  | /* previous device */ | 
|  | char *last_name; | 
|  | char *last_base; | 
|  | char *last_unit; | 
|  | char *last_args; | 
|  | /* work area */ | 
|  | char buf[1024]; | 
|  | } name_specifier; | 
|  |  | 
|  |  | 
|  |  | 
|  | /* Given a device specifier, break it up into its main components: | 
|  | path (and if present) property name and property value. */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (int) | 
|  | split_device_specifier(device *current, | 
|  | const char *device_specifier, | 
|  | name_specifier *spec) | 
|  | { | 
|  | char *chp = NULL; | 
|  |  | 
|  | /* expand any leading alias if present */ | 
|  | if (current != NULL | 
|  | && *device_specifier != '\0' | 
|  | && *device_specifier != '.' | 
|  | && *device_specifier != '/') { | 
|  | device *aliases = tree_find_device(current, "/aliases"); | 
|  | char alias[32]; | 
|  | int len = 0; | 
|  | while (device_specifier[len] != '\0' | 
|  | && device_specifier[len] != '/' | 
|  | && device_specifier[len] != ':' | 
|  | && !isspace(device_specifier[len])) { | 
|  | alias[len] = device_specifier[len]; | 
|  | len++; | 
|  | if (len >= sizeof(alias)) | 
|  | error("split_device_specifier: buffer overflow"); | 
|  | } | 
|  | alias[len] = '\0'; | 
|  | if (aliases != NULL | 
|  | && device_find_property(aliases, alias)) { | 
|  | strcpy(spec->buf, device_find_string_property(aliases, alias)); | 
|  | strcat(spec->buf, device_specifier + len); | 
|  | } | 
|  | else { | 
|  | strcpy(spec->buf, device_specifier); | 
|  | } | 
|  | } | 
|  | else { | 
|  | strcpy(spec->buf, device_specifier); | 
|  | } | 
|  |  | 
|  | /* check no overflow */ | 
|  | if (strlen(spec->buf) >= sizeof(spec->buf)) | 
|  | error("split_device_specifier: buffer overflow\n"); | 
|  |  | 
|  | /* strip leading spaces */ | 
|  | chp = spec->buf; | 
|  | while (*chp != '\0' && isspace(*chp)) | 
|  | chp++; | 
|  | if (*chp == '\0') | 
|  | return 0; | 
|  |  | 
|  | /* find the path and terminate it with null */ | 
|  | spec->path = chp; | 
|  | while (*chp != '\0' && !isspace(*chp)) | 
|  | chp++; | 
|  | if (*chp != '\0') { | 
|  | *chp = '\0'; | 
|  | chp++; | 
|  | } | 
|  |  | 
|  | /* and any value */ | 
|  | while (*chp != '\0' && isspace(*chp)) | 
|  | chp++; | 
|  | spec->value = chp; | 
|  |  | 
|  | /* now go back and chop the property off of the path */ | 
|  | if (spec->value[0] == '\0') { | 
|  | spec->property = NULL; /*not a property*/ | 
|  | spec->value = NULL; | 
|  | } | 
|  | else if (spec->value[0] == '>' | 
|  | || spec->value[0] == '<') { | 
|  | /* an interrupt spec */ | 
|  | spec->property = NULL; | 
|  | } | 
|  | else { | 
|  | chp = strrchr(spec->path, '/'); | 
|  | if (chp == NULL) { | 
|  | spec->property = spec->path; | 
|  | spec->path = strchr(spec->property, '\0'); | 
|  | } | 
|  | else { | 
|  | *chp = '\0'; | 
|  | spec->property = chp+1; | 
|  | } | 
|  | } | 
|  |  | 
|  | /* and mark the rest as invalid */ | 
|  | spec->name = NULL; | 
|  | spec->base = NULL; | 
|  | spec->unit = NULL; | 
|  | spec->args = NULL; | 
|  | spec->last_name = NULL; | 
|  | spec->last_base = NULL; | 
|  | spec->last_unit = NULL; | 
|  | spec->last_args = NULL; | 
|  |  | 
|  | return 1; | 
|  | } | 
|  |  | 
|  |  | 
|  | /* given a device specifier break it up into its main components - | 
|  | path and property name - assuming that the last `device' is a | 
|  | property name. */ | 
|  |  | 
|  | STATIC_INLINE_DEVICE\ | 
|  | (int) | 
|  | split_property_specifier(device *current, | 
|  | const char *property_specifier, | 
|  | name_specifier *spec) | 
|  | { | 
|  | if (split_device_specifier(current, property_specifier, spec)) { | 
|  | if (spec->property == NULL) { | 
|  | /* force the last name to be a property name */ | 
|  | char *chp = strrchr(spec->path, '/'); | 
|  | if (chp == NULL) { | 
|  | spec->property = spec->path; | 
|  | spec->path = strrchr(spec->property, '\0');; | 
|  | } | 
|  | else { | 
|  | *chp = '\0'; | 
|  | spec->property = chp+1; | 
|  | } | 
|  | } | 
|  | return 1; | 
|  | } | 
|  | else | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | /* device the next device name and split it up, return 0 when no more | 
|  | names to device */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (int) | 
|  | split_device_name(name_specifier *spec) | 
|  | { | 
|  | char *chp; | 
|  | /* remember what came before */ | 
|  | spec->last_name = spec->name; | 
|  | spec->last_base = spec->base; | 
|  | spec->last_unit = spec->unit; | 
|  | spec->last_args = spec->args; | 
|  | /* finished? */ | 
|  | if (spec->path[0] == '\0') { | 
|  | spec->name = NULL; | 
|  | spec->base = NULL; | 
|  | spec->unit = NULL; | 
|  | spec->args = NULL; | 
|  | return 0; | 
|  | } | 
|  | /* break the current device spec from the path */ | 
|  | spec->name = spec->path; | 
|  | chp = strchr(spec->name, '/'); | 
|  | if (chp == NULL) | 
|  | spec->path = strchr(spec->name, '\0'); | 
|  | else { | 
|  | spec->path = chp+1; | 
|  | *chp = '\0'; | 
|  | } | 
|  | /* break out the base */ | 
|  | if (spec->name[0] == '(') { | 
|  | chp = strchr(spec->name, ')'); | 
|  | if (chp == NULL) { | 
|  | spec->base = spec->name; | 
|  | } | 
|  | else { | 
|  | *chp = '\0'; | 
|  | spec->base = spec->name + 1; | 
|  | spec->name = chp + 1; | 
|  | } | 
|  | } | 
|  | else { | 
|  | spec->base = spec->name; | 
|  | } | 
|  | /* now break out the unit */ | 
|  | chp = strchr(spec->name, '@'); | 
|  | if (chp == NULL) { | 
|  | spec->unit = NULL; | 
|  | chp = spec->name; | 
|  | } | 
|  | else { | 
|  | *chp = '\0'; | 
|  | chp += 1; | 
|  | spec->unit = chp; | 
|  | } | 
|  | /* finally any args */ | 
|  | chp = strchr(chp, ':'); | 
|  | if (chp == NULL) | 
|  | spec->args = NULL; | 
|  | else { | 
|  | *chp = '\0'; | 
|  | spec->args = chp+1; | 
|  | } | 
|  | return 1; | 
|  | } | 
|  |  | 
|  |  | 
|  | /* device the value, returning the next non-space token */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (char *) | 
|  | split_value(name_specifier *spec) | 
|  | { | 
|  | char *token; | 
|  | if (spec->value == NULL) | 
|  | return NULL; | 
|  | /* skip leading white space */ | 
|  | while (isspace(spec->value[0])) | 
|  | spec->value++; | 
|  | if (spec->value[0] == '\0') { | 
|  | spec->value = NULL; | 
|  | return NULL; | 
|  | } | 
|  | token = spec->value; | 
|  | /* find trailing space */ | 
|  | while (spec->value[0] != '\0' && !isspace(spec->value[0])) | 
|  | spec->value++; | 
|  | /* chop this value out */ | 
|  | if (spec->value[0] != '\0') { | 
|  | spec->value[0] = '\0'; | 
|  | spec->value++; | 
|  | } | 
|  | return token; | 
|  | } | 
|  |  | 
|  |  | 
|  |  | 
|  | /* traverse the path specified by spec starting at current */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (device *) | 
|  | split_find_device(device *current, | 
|  | name_specifier *spec) | 
|  | { | 
|  | /* strip off (and process) any leading ., .., ./ and / */ | 
|  | while (1) { | 
|  | if (strncmp(spec->path, "/", strlen("/")) == 0) { | 
|  | /* cd /... */ | 
|  | while (current != NULL && device_parent(current) != NULL) | 
|  | current = device_parent(current); | 
|  | spec->path += strlen("/"); | 
|  | } | 
|  | else if (strncmp(spec->path, "./", strlen("./")) == 0) { | 
|  | /* cd ./... */ | 
|  | spec->path += strlen("./"); | 
|  | } | 
|  | else if (strncmp(spec->path, "../", strlen("../")) == 0) { | 
|  | /* cd ../... */ | 
|  | if (current != NULL && device_parent(current) != NULL) | 
|  | current = device_parent(current); | 
|  | spec->path += strlen("../"); | 
|  | } | 
|  | else if (strcmp(spec->path, ".") == 0) { | 
|  | /* cd . */ | 
|  | spec->path += strlen("."); | 
|  | } | 
|  | else if (strcmp(spec->path, "..") == 0) { | 
|  | /* cd . */ | 
|  | if (current != NULL && device_parent(current) != NULL) | 
|  | current = device_parent(current); | 
|  | spec->path += strlen(".."); | 
|  | } | 
|  | else | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* now go through the path proper */ | 
|  |  | 
|  | if (current == NULL) { | 
|  | split_device_name(spec); | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | while (split_device_name(spec)) { | 
|  | device *child; | 
|  | for (child = device_child(current); | 
|  | child != NULL; child = device_sibling(child)) { | 
|  | if (strcmp(spec->name, device_name(child)) == 0) { | 
|  | if (spec->unit == NULL) | 
|  | break; | 
|  | else { | 
|  | device_unit phys; | 
|  | device_decode_unit(current, spec->unit, &phys); | 
|  | if (memcmp(&phys, device_unit_address(child), | 
|  | sizeof(device_unit)) == 0) | 
|  | break; | 
|  | } | 
|  | } | 
|  | } | 
|  | if (child == NULL) | 
|  | return current; /* search failed */ | 
|  | current = child; | 
|  | } | 
|  |  | 
|  | return current; | 
|  | } | 
|  |  | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (device *) | 
|  | split_fill_path(device *current, | 
|  | const char *device_specifier, | 
|  | name_specifier *spec) | 
|  | { | 
|  | /* break it up */ | 
|  | if (!split_device_specifier(current, device_specifier, spec)) | 
|  | device_error(current, "error parsing %s\n", device_specifier); | 
|  |  | 
|  | /* fill our tree with its contents */ | 
|  | current = split_find_device(current, spec); | 
|  |  | 
|  | /* add any additional devices as needed */ | 
|  | if (spec->name != NULL) { | 
|  | do { | 
|  | current = device_create(current, spec->base, spec->name, | 
|  | spec->unit, spec->args); | 
|  | } while (split_device_name(spec)); | 
|  | } | 
|  |  | 
|  | return current; | 
|  | } | 
|  |  | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (void) | 
|  | tree_init(device *root, | 
|  | psim *system) | 
|  | { | 
|  | TRACE(trace_device_tree, ("tree_init(root=%p, system=%p)\n", | 
|  | root, | 
|  | system)); | 
|  | /* remove the old, rebuild the new */ | 
|  | tree_traverse(root, device_clean, NULL, system); | 
|  | tree_traverse(root, device_init_static_properties, NULL, system); | 
|  | tree_traverse(root, device_init_address, NULL, system); | 
|  | tree_traverse(root, device_init_runtime_properties, NULL, system); | 
|  | tree_traverse(root, device_init_data, NULL, system); | 
|  | } | 
|  |  | 
|  |  | 
|  |  | 
|  | /* <non-white-space> */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (const char *) | 
|  | skip_token(const char *chp) | 
|  | { | 
|  | while (!isspace(*chp) && *chp != '\0') | 
|  | chp++; | 
|  | while (isspace(*chp) && *chp != '\0') | 
|  | chp++; | 
|  | return chp; | 
|  | } | 
|  |  | 
|  |  | 
|  | /* count the number of entries */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (int) | 
|  | count_entries(device *current, | 
|  | const char *property_name, | 
|  | const char *property_value, | 
|  | int modulo) | 
|  | { | 
|  | const char *chp = property_value; | 
|  | int nr_entries = 0; | 
|  | while (*chp != '\0') { | 
|  | nr_entries += 1; | 
|  | chp = skip_token(chp); | 
|  | } | 
|  | if ((nr_entries % modulo) != 0) { | 
|  | device_error(current, "incorrect number of entries for %s property %s, should be multiple of %d", | 
|  | property_name, property_value, modulo); | 
|  | } | 
|  | return nr_entries / modulo; | 
|  | } | 
|  |  | 
|  |  | 
|  |  | 
|  | /* parse: <address> ::= <token> ; device dependant */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (const char *) | 
|  | parse_address(device *current, | 
|  | device *bus, | 
|  | const char *chp, | 
|  | device_unit *address) | 
|  | { | 
|  | ASSERT(device_nr_address_cells(bus) > 0); | 
|  | if (device_decode_unit(bus, chp, address) < 0) | 
|  | device_error(current, "invalid unit address in %s", chp); | 
|  | return skip_token(chp); | 
|  | } | 
|  |  | 
|  |  | 
|  | /* parse: <size> ::= <number> { "," <number> } ; */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (const char *) | 
|  | parse_size(device *current, | 
|  | device *bus, | 
|  | const char *chp, | 
|  | device_unit *size) | 
|  | { | 
|  | int i; | 
|  | int nr; | 
|  | const char *curr = chp; | 
|  | memset(size, 0, sizeof(*size)); | 
|  | /* parse the numeric list */ | 
|  | size->nr_cells = device_nr_size_cells(bus); | 
|  | nr = 0; | 
|  | ASSERT(size->nr_cells > 0); | 
|  | while (1) { | 
|  | char *next; | 
|  | size->cells[nr] = strtoul(curr, &next, 0); | 
|  | if (curr == next) | 
|  | device_error(current, "Problem parsing <size> %s", chp); | 
|  | nr += 1; | 
|  | if (next[0] != ',') | 
|  | break; | 
|  | if (nr == size->nr_cells) | 
|  | device_error(current, "Too many values in <size> %s", chp); | 
|  | curr = next + 1; | 
|  | } | 
|  | ASSERT(nr > 0 && nr <= size->nr_cells); | 
|  | /* right align the numbers */ | 
|  | for (i = 1; i <= size->nr_cells; i++) { | 
|  | if (i <= nr) | 
|  | size->cells[size->nr_cells - i] = size->cells[nr - i]; | 
|  | else | 
|  | size->cells[size->nr_cells - i] = 0; | 
|  | } | 
|  | return skip_token(chp); | 
|  | } | 
|  |  | 
|  |  | 
|  | /* parse: <reg> ::= { <address> <size> } ; */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | parse_reg_property(device *current, | 
|  | const char *property_name, | 
|  | const char *property_value) | 
|  | { | 
|  | int nr_regs; | 
|  | int reg_nr; | 
|  | reg_property_spec *regs; | 
|  | const char *chp; | 
|  | device *bus = device_parent(current); | 
|  |  | 
|  | /* determine the number of reg entries by counting tokens */ | 
|  | nr_regs = count_entries(current, property_name, property_value, | 
|  | 1 + (device_nr_size_cells(bus) > 0)); | 
|  |  | 
|  | /* create working space */ | 
|  | regs = zalloc(nr_regs * sizeof(*regs)); | 
|  |  | 
|  | /* fill it in */ | 
|  | chp = property_value; | 
|  | for (reg_nr = 0; reg_nr < nr_regs; reg_nr++) { | 
|  | chp = parse_address(current, bus, chp, ®s[reg_nr].address); | 
|  | if (device_nr_size_cells(bus) > 0) | 
|  | chp = parse_size(current, bus, chp, ®s[reg_nr].size); | 
|  | else | 
|  | memset(®s[reg_nr].size, 0, sizeof (regs[reg_nr].size)); | 
|  | } | 
|  |  | 
|  | /* create it */ | 
|  | device_add_reg_array_property(current, property_name, | 
|  | regs, nr_regs); | 
|  |  | 
|  | free(regs); | 
|  | } | 
|  |  | 
|  |  | 
|  | /* { <child-address> <parent-address> <child-size> }* */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | parse_ranges_property(device *current, | 
|  | const char *property_name, | 
|  | const char *property_value) | 
|  | { | 
|  | int nr_ranges; | 
|  | int range_nr; | 
|  | range_property_spec *ranges; | 
|  | const char *chp; | 
|  |  | 
|  | /* determine the number of ranges specified */ | 
|  | nr_ranges = count_entries(current, property_name, property_value, 3); | 
|  |  | 
|  | /* create a property of that size */ | 
|  | ranges = zalloc(nr_ranges * sizeof(*ranges)); | 
|  |  | 
|  | /* fill it in */ | 
|  | chp = property_value; | 
|  | for (range_nr = 0; range_nr < nr_ranges; range_nr++) { | 
|  | chp = parse_address(current, current, | 
|  | chp, &ranges[range_nr].child_address); | 
|  | chp = parse_address(current, device_parent(current), | 
|  | chp, &ranges[range_nr].parent_address); | 
|  | chp = parse_size(current, current, | 
|  | chp, &ranges[range_nr].size); | 
|  | } | 
|  |  | 
|  | /* create it */ | 
|  | device_add_range_array_property(current, property_name, ranges, nr_ranges); | 
|  |  | 
|  | free(ranges); | 
|  | } | 
|  |  | 
|  |  | 
|  | /* <integer> ... */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | parse_integer_property(device *current, | 
|  | const char *property_name, | 
|  | const char *property_value) | 
|  | { | 
|  | int nr_entries; | 
|  | unsigned_cell words[1024]; | 
|  | /* integer or integer array? */ | 
|  | nr_entries = 0; | 
|  | while (1) { | 
|  | char *end; | 
|  | words[nr_entries] = strtoul(property_value, &end, 0); | 
|  | if (property_value == end) | 
|  | break; | 
|  | nr_entries += 1; | 
|  | if (nr_entries * sizeof(words[0]) >= sizeof(words)) | 
|  | device_error(current, "buffer overflow"); | 
|  | property_value = end; | 
|  | } | 
|  | if (nr_entries == 0) | 
|  | device_error(current, "error parsing integer property %s (%s)", | 
|  | property_name, property_value); | 
|  | else if (nr_entries == 1) | 
|  | device_add_integer_property(current, property_name, words[0]); | 
|  | else { | 
|  | int i; | 
|  | for (i = 0; i < nr_entries; i++) { | 
|  | H2BE(words[i]); | 
|  | } | 
|  | /* perhaps integer array property is better */ | 
|  | device_add_array_property(current, property_name, words, | 
|  | sizeof(words[0]) * nr_entries); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* PROPERTY_VALUE is a raw property value.  Quote it as required by | 
|  | parse_string_property.  It is the caller's responsibility to free | 
|  | the memory returned.  */ | 
|  |  | 
|  | EXTERN_TREE\ | 
|  | (char *) | 
|  | tree_quote_property(const char *property_value) | 
|  | { | 
|  | char *p; | 
|  | char *ret; | 
|  | const char *chp; | 
|  | int quotees; | 
|  |  | 
|  | /* Count characters needing quotes in PROPERTY_VALUE.  */ | 
|  | quotees = 0; | 
|  | for (chp = property_value; *chp; ++chp) | 
|  | if (*chp == '\\' || *chp == '"') | 
|  | ++quotees; | 
|  |  | 
|  | ret = (char *) xmalloc (strlen (property_value) | 
|  | + 2 /* quotes */ | 
|  | + quotees | 
|  | + 1 /* terminator */); | 
|  |  | 
|  | p = ret; | 
|  | /* Add the opening quote.  */ | 
|  | *p++ = '"'; | 
|  | /* Copy the value.  */ | 
|  | for (chp = property_value; *chp; ++chp) | 
|  | if (*chp == '\\' || *chp == '"') | 
|  | { | 
|  | /* Quote this character.  */ | 
|  | *p++ = '\\'; | 
|  | *p++ = *chp; | 
|  | } | 
|  | else | 
|  | *p++ = *chp; | 
|  | /* Add the closing quote.  */ | 
|  | *p++ = '"'; | 
|  | /* Terminate the string.  */ | 
|  | *p++ = '\0'; | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* <string> ... */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | parse_string_property(device *current, | 
|  | const char *property_name, | 
|  | const char *property_value) | 
|  | { | 
|  | char **strings; | 
|  | const char *chp; | 
|  | int nr_strings; | 
|  | int approx_nr_strings; | 
|  |  | 
|  | /* get an estimate as to the number of strings by counting double | 
|  | quotes */ | 
|  | approx_nr_strings = 2; | 
|  | for (chp = property_value; *chp; chp++) { | 
|  | if (*chp == '"') | 
|  | approx_nr_strings++; | 
|  | } | 
|  | approx_nr_strings = (approx_nr_strings) / 2; | 
|  |  | 
|  | /* create a string buffer for that many (plus a null) */ | 
|  | strings = (char**)zalloc((approx_nr_strings + 1) * sizeof(char*)); | 
|  |  | 
|  | /* now find all the strings */ | 
|  | chp = property_value; | 
|  | nr_strings = 0; | 
|  | while (1) { | 
|  |  | 
|  | /* skip leading space */ | 
|  | while (*chp != '\0' && isspace(*chp)) | 
|  | chp += 1; | 
|  | if (*chp == '\0') | 
|  | break; | 
|  |  | 
|  | /* copy it in */ | 
|  | if (*chp == '"') { | 
|  | /* a quoted string - watch for '\' et.al. */ | 
|  | /* estimate the size and allocate space for it */ | 
|  | int pos; | 
|  | chp++; | 
|  | pos = 0; | 
|  | while (chp[pos] != '\0' && chp[pos] != '"') { | 
|  | if (chp[pos] == '\\' && chp[pos+1] != '\0') | 
|  | pos += 2; | 
|  | else | 
|  | pos += 1; | 
|  | } | 
|  | strings[nr_strings] = zalloc(pos + 1); | 
|  | /* copy the string over */ | 
|  | pos = 0; | 
|  | while (*chp != '\0' && *chp != '"') { | 
|  | if (*chp == '\\' && *(chp+1) != '\0') { | 
|  | strings[nr_strings][pos] = *(chp+1); | 
|  | chp += 2; | 
|  | pos++; | 
|  | } | 
|  | else { | 
|  | strings[nr_strings][pos] = *chp; | 
|  | chp += 1; | 
|  | pos++; | 
|  | } | 
|  | } | 
|  | if (*chp != '\0') | 
|  | chp++; | 
|  | strings[nr_strings][pos] = '\0'; | 
|  | } | 
|  | else { | 
|  | /* copy over a single unquoted token */ | 
|  | int len = 0; | 
|  | while (chp[len] != '\0' && !isspace(chp[len])) | 
|  | len++; | 
|  | strings[nr_strings] = zalloc(len + 1); | 
|  | strncpy(strings[nr_strings], chp, len); | 
|  | strings[nr_strings][len] = '\0'; | 
|  | chp += len; | 
|  | } | 
|  | nr_strings++; | 
|  | if (nr_strings > approx_nr_strings) | 
|  | device_error(current, "String property %s badly formatted", | 
|  | property_name); | 
|  | } | 
|  | ASSERT(strings[nr_strings] == NULL); /* from zalloc */ | 
|  |  | 
|  | /* install it */ | 
|  | if (nr_strings == 0) | 
|  | device_add_string_property(current, property_name, ""); | 
|  | else if (nr_strings == 1) | 
|  | device_add_string_property(current, property_name, strings[0]); | 
|  | else { | 
|  | const char **specs = (const char**)strings; /* stop a bogus error */ | 
|  | device_add_string_array_property(current, property_name, | 
|  | specs, nr_strings); | 
|  | } | 
|  |  | 
|  | /* flush the created string */ | 
|  | while (nr_strings > 0) { | 
|  | nr_strings--; | 
|  | free(strings[nr_strings]); | 
|  | } | 
|  | free(strings); | 
|  | } | 
|  |  | 
|  |  | 
|  | /* <path-to-ihandle-device> */ | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | parse_ihandle_property(device *current, | 
|  | const char *property, | 
|  | const char *value) | 
|  | { | 
|  | ihandle_runtime_property_spec ihandle; | 
|  |  | 
|  | /* pass the full path */ | 
|  | ihandle.full_path = value; | 
|  |  | 
|  | /* save this ready for the ihandle create */ | 
|  | device_add_ihandle_runtime_property(current, property, | 
|  | &ihandle); | 
|  | } | 
|  |  | 
|  |  | 
|  |  | 
|  | EXTERN_TREE\ | 
|  | (device *) | 
|  | tree_parse(device *current, | 
|  | const char *fmt, | 
|  | ...) | 
|  | { | 
|  | char device_specifier[1024]; | 
|  | name_specifier spec; | 
|  |  | 
|  | /* format the path */ | 
|  | { | 
|  | va_list ap; | 
|  | va_start(ap, fmt); | 
|  | vsprintf(device_specifier, fmt, ap); | 
|  | va_end(ap); | 
|  | if (strlen(device_specifier) >= sizeof(device_specifier)) | 
|  | error("device_tree_add_deviced: buffer overflow\n"); | 
|  | } | 
|  |  | 
|  | /* construct the tree down to the final device */ | 
|  | current = split_fill_path(current, device_specifier, &spec); | 
|  |  | 
|  | /* is there an interrupt spec */ | 
|  | if (spec.property == NULL | 
|  | && spec.value != NULL) { | 
|  | char *op = split_value(&spec); | 
|  | switch (op[0]) { | 
|  | case '>': | 
|  | { | 
|  | char *my_port_name = split_value(&spec); | 
|  | int my_port; | 
|  | char *dest_port_name = split_value(&spec); | 
|  | int dest_port; | 
|  | name_specifier dest_spec; | 
|  | char *dest_device_name = split_value(&spec); | 
|  | device *dest; | 
|  | /* find my name */ | 
|  | my_port = device_interrupt_decode(current, my_port_name, | 
|  | output_port); | 
|  | /* find the dest device and port */ | 
|  | dest = split_fill_path(current, dest_device_name, &dest_spec); | 
|  | dest_port = device_interrupt_decode(dest, dest_port_name, | 
|  | input_port); | 
|  | /* connect the two */ | 
|  | device_interrupt_attach(current, | 
|  | my_port, | 
|  | dest, | 
|  | dest_port, | 
|  | permenant_object); | 
|  | } | 
|  | break; | 
|  | default: | 
|  | device_error(current, "unreconised interrupt spec %s\n", spec.value); | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | /* is there a property */ | 
|  | if (spec.property != NULL) { | 
|  | if (strcmp(spec.value, "true") == 0) | 
|  | device_add_boolean_property(current, spec.property, 1); | 
|  | else if (strcmp(spec.value, "false") == 0) | 
|  | device_add_boolean_property(current, spec.property, 0); | 
|  | else { | 
|  | const device_property *property; | 
|  | switch (spec.value[0]) { | 
|  | case '*': | 
|  | parse_ihandle_property(current, spec.property, spec.value + 1); | 
|  | break; | 
|  | case '[': | 
|  | { | 
|  | uint8_t words[1024]; | 
|  | char *curr = spec.value + 1; | 
|  | int nr_words = 0; | 
|  | while (1) { | 
|  | char *next; | 
|  | words[nr_words] = H2BE_1(strtoul(curr, &next, 0)); | 
|  | if (curr == next) | 
|  | break; | 
|  | curr = next; | 
|  | nr_words += 1; | 
|  | } | 
|  | device_add_array_property(current, spec.property, | 
|  | words, sizeof(words[0]) * nr_words); | 
|  | } | 
|  | break; | 
|  | case '"': | 
|  | parse_string_property(current, spec.property, spec.value); | 
|  | break; | 
|  | case '!': | 
|  | spec.value++; | 
|  | property = tree_find_property(current, spec.value); | 
|  | if (property == NULL) | 
|  | device_error(current, "property %s not found\n", spec.value); | 
|  | device_add_duplicate_property(current, | 
|  | spec.property, | 
|  | property); | 
|  | break; | 
|  | default: | 
|  | if (strcmp(spec.property, "reg") == 0 | 
|  | || strcmp(spec.property, "assigned-addresses") == 0 | 
|  | || strcmp(spec.property, "alternate-reg") == 0){ | 
|  | parse_reg_property(current, spec.property, spec.value); | 
|  | } | 
|  | else if (strcmp(spec.property, "ranges") == 0) { | 
|  | parse_ranges_property(current, spec.property, spec.value); | 
|  | } | 
|  | else if (isdigit(spec.value[0]) | 
|  | || (spec.value[0] == '-' && isdigit(spec.value[1])) | 
|  | || (spec.value[0] == '+' && isdigit(spec.value[1]))) { | 
|  | parse_integer_property(current, spec.property, spec.value); | 
|  | } | 
|  | else | 
|  | parse_string_property(current, spec.property, spec.value); | 
|  | break; | 
|  | } | 
|  | } | 
|  | } | 
|  | return current; | 
|  | } | 
|  |  | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (void) | 
|  | tree_traverse(device *root, | 
|  | tree_traverse_function *prefix, | 
|  | tree_traverse_function *postfix, | 
|  | void *data) | 
|  | { | 
|  | device *child; | 
|  | if (prefix != NULL) | 
|  | prefix(root, data); | 
|  | for (child = device_child(root); | 
|  | child != NULL; | 
|  | child = device_sibling(child)) { | 
|  | tree_traverse(child, prefix, postfix, data); | 
|  | } | 
|  | if (postfix != NULL) | 
|  | postfix(root, data); | 
|  | } | 
|  |  | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | print_address(device *bus, | 
|  | const device_unit *phys) | 
|  | { | 
|  | char unit[32]; | 
|  | device_encode_unit(bus, phys, unit, sizeof(unit)); | 
|  | printf_filtered(" %s", unit); | 
|  | } | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | print_size(device *bus, | 
|  | const device_unit *size) | 
|  | { | 
|  | int i; | 
|  | for (i = 0; i < size->nr_cells; i++) | 
|  | if (size->cells[i] != 0) | 
|  | break; | 
|  | if (i < size->nr_cells) { | 
|  | printf_filtered(" 0x%lx", (unsigned long)size->cells[i]); | 
|  | i++; | 
|  | for (; i < size->nr_cells; i++) | 
|  | printf_filtered(",0x%lx", (unsigned long)size->cells[i]); | 
|  | } | 
|  | else | 
|  | printf_filtered(" 0"); | 
|  | } | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | print_reg_property(device *me, | 
|  | const device_property *property) | 
|  | { | 
|  | int reg_nr; | 
|  | reg_property_spec reg; | 
|  | for (reg_nr = 0; | 
|  | device_find_reg_array_property(me, property->name, reg_nr, ®); | 
|  | reg_nr++) { | 
|  | print_address(device_parent(me), ®.address); | 
|  | print_size(me, ®.size); | 
|  | } | 
|  | } | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | print_ranges_property(device *me, | 
|  | const device_property *property) | 
|  | { | 
|  | int range_nr; | 
|  | range_property_spec range; | 
|  | for (range_nr = 0; | 
|  | device_find_range_array_property(me, property->name, range_nr, &range); | 
|  | range_nr++) { | 
|  | print_address(me, &range.child_address); | 
|  | print_address(device_parent(me), &range.parent_address); | 
|  | print_size(me, &range.size); | 
|  | } | 
|  | } | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | print_string(const char *string) | 
|  | { | 
|  | printf_filtered(" \""); | 
|  | while (*string != '\0') { | 
|  | switch (*string) { | 
|  | case '"': | 
|  | printf_filtered("\\\""); | 
|  | break; | 
|  | case '\\': | 
|  | printf_filtered("\\\\"); | 
|  | break; | 
|  | default: | 
|  | printf_filtered("%c", *string); | 
|  | break; | 
|  | } | 
|  | string++; | 
|  | } | 
|  | printf_filtered("\""); | 
|  | } | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | print_string_array_property(device *me, | 
|  | const device_property *property) | 
|  | { | 
|  | int nr; | 
|  | string_property_spec string; | 
|  | for (nr = 0; | 
|  | device_find_string_array_property(me, property->name, nr, &string); | 
|  | nr++) { | 
|  | print_string(string); | 
|  | } | 
|  | } | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | print_properties(device *me) | 
|  | { | 
|  | const device_property *property; | 
|  | for (property = device_find_property(me, NULL); | 
|  | property != NULL; | 
|  | property = device_next_property(property)) { | 
|  | printf_filtered("%s/%s", device_path(me), property->name); | 
|  | if (property->original != NULL) { | 
|  | printf_filtered(" !"); | 
|  | printf_filtered("%s/%s", | 
|  | device_path(property->original->owner), | 
|  | property->original->name); | 
|  | } | 
|  | else { | 
|  | switch (property->type) { | 
|  | case array_property: | 
|  | if ((property->sizeof_array % sizeof(signed_cell)) == 0) { | 
|  | unsigned_cell *w = (unsigned_cell*)property->array; | 
|  | int cell_nr; | 
|  | for (cell_nr = 0; | 
|  | cell_nr < (property->sizeof_array / sizeof(unsigned_cell)); | 
|  | cell_nr++) { | 
|  | printf_filtered(" 0x%lx", (unsigned long)BE2H_cell(w[cell_nr])); | 
|  | } | 
|  | } | 
|  | else { | 
|  | uint8_t *w = (uint8_t*)property->array; | 
|  | printf_filtered(" ["); | 
|  | while ((char*)w - (char*)property->array < property->sizeof_array) { | 
|  | printf_filtered(" 0x%2x", BE2H_1(*w)); | 
|  | w++; | 
|  | } | 
|  | } | 
|  | break; | 
|  | case boolean_property: | 
|  | { | 
|  | int b = device_find_boolean_property(me, property->name); | 
|  | printf_filtered(" %s", b ? "true"  : "false"); | 
|  | } | 
|  | break; | 
|  | case ihandle_property: | 
|  | { | 
|  | if (property->array != NULL) { | 
|  | device_instance *instance = device_find_ihandle_property(me, property->name); | 
|  | printf_filtered(" *%s", device_instance_path(instance)); | 
|  | } | 
|  | else { | 
|  | /* not yet initialized, ask the device for the path */ | 
|  | ihandle_runtime_property_spec spec; | 
|  | device_find_ihandle_runtime_property(me, property->name, &spec); | 
|  | printf_filtered(" *%s", spec.full_path); | 
|  | } | 
|  | } | 
|  | break; | 
|  | case integer_property: | 
|  | { | 
|  | unsigned_word w = device_find_integer_property(me, property->name); | 
|  | printf_filtered(" 0x%lx", (unsigned long)w); | 
|  | } | 
|  | break; | 
|  | case range_array_property: | 
|  | print_ranges_property(me, property); | 
|  | break; | 
|  | case reg_array_property: | 
|  | print_reg_property(me, property); | 
|  | break; | 
|  | case string_property: | 
|  | { | 
|  | const char *s = device_find_string_property(me, property->name); | 
|  | print_string(s); | 
|  | } | 
|  | break; | 
|  | case string_array_property: | 
|  | print_string_array_property(me, property); | 
|  | break; | 
|  | } | 
|  | } | 
|  | printf_filtered("\n"); | 
|  | } | 
|  | } | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | print_interrupts(device *me, | 
|  | int my_port, | 
|  | device *dest, | 
|  | int dest_port, | 
|  | void *ignore_or_null) | 
|  | { | 
|  | char src[32]; | 
|  | char dst[32]; | 
|  | device_interrupt_encode(me, my_port, src, sizeof(src), output_port); | 
|  | device_interrupt_encode(dest, dest_port, dst, sizeof(dst), input_port); | 
|  | printf_filtered("%s > %s %s %s\n", | 
|  | device_path(me), | 
|  | src, dst, | 
|  | device_path(dest)); | 
|  | } | 
|  |  | 
|  | STATIC_INLINE_TREE\ | 
|  | (void) | 
|  | print_device(device *me, | 
|  | void *ignore_or_null) | 
|  | { | 
|  | printf_filtered("%s\n", device_path(me)); | 
|  | print_properties(me); | 
|  | device_interrupt_traverse(me, print_interrupts, NULL); | 
|  | } | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (void) | 
|  | tree_print(device *root) | 
|  | { | 
|  | tree_traverse(root, | 
|  | print_device, NULL, | 
|  | NULL); | 
|  | } | 
|  |  | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (void) | 
|  | tree_usage(int verbose) | 
|  | { | 
|  | if (verbose == 1) { | 
|  | printf_filtered("\n"); | 
|  | printf_filtered("A device/property specifier has the form:\n"); | 
|  | printf_filtered("\n"); | 
|  | printf_filtered("  /path/to/a/device [ property-value ]\n"); | 
|  | printf_filtered("\n"); | 
|  | printf_filtered("and a possible device is\n"); | 
|  | printf_filtered("\n"); | 
|  | } | 
|  | if (verbose > 1) { | 
|  | printf_filtered("\n"); | 
|  | printf_filtered("A device/property specifier (<spec>) has the format:\n"); | 
|  | printf_filtered("\n"); | 
|  | printf_filtered("  <spec> ::= <path> [ <value> ] ;\n"); | 
|  | printf_filtered("  <path> ::= { <prefix> } { <node> \"/\" } <node> ;\n"); | 
|  | printf_filtered("  <prefix> ::= ( | \"/\" | \"../\" | \"./\" ) ;\n"); | 
|  | printf_filtered("  <node> ::= <name> [ \"@\" <unit> ] [ \":\" <args> ] ;\n"); | 
|  | printf_filtered("  <unit> ::= <number> { \",\" <number> } ;\n"); | 
|  | printf_filtered("\n"); | 
|  | printf_filtered("Where:\n"); | 
|  | printf_filtered("\n"); | 
|  | printf_filtered("  <name>  is the name of a device (list below)\n"); | 
|  | printf_filtered("  <unit>  is the unit-address relative to the parent bus\n"); | 
|  | printf_filtered("  <args>  additional arguments used when creating the device\n"); | 
|  | printf_filtered("  <value> ::= ( <number> # integer property\n"); | 
|  | printf_filtered("              | \"[\" { <number> } # array property (byte)\n"); | 
|  | printf_filtered("              | \"{\" { <number> } # array property (cell)\n"); | 
|  | printf_filtered("              | [ \"true\" | \"false\" ] # boolean property\n"); | 
|  | printf_filtered("              | \"*\" <path> # ihandle property\n"); | 
|  | printf_filtered("              | \"!\" <path> # copy property\n"); | 
|  | printf_filtered("              | \">\" [ <number> ] <path> # attach interrupt\n"); | 
|  | printf_filtered("              | \"<\" <path> # attach child interrupt\n"); | 
|  | printf_filtered("              | \"\\\"\" <text> # string property\n"); | 
|  | printf_filtered("              | <text> # string property\n"); | 
|  | printf_filtered("              ) ;\n"); | 
|  | printf_filtered("\n"); | 
|  | printf_filtered("And the following are valid device names:\n"); | 
|  | printf_filtered("\n"); | 
|  | } | 
|  | } | 
|  |  | 
|  |  | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (device_instance *) | 
|  | tree_instance(device *root, | 
|  | const char *device_specifier) | 
|  | { | 
|  | /* find the device node */ | 
|  | device *me; | 
|  | name_specifier spec; | 
|  | if (!split_device_specifier(root, device_specifier, &spec)) | 
|  | return NULL; | 
|  | me = split_find_device(root, &spec); | 
|  | if (spec.name != NULL) | 
|  | return NULL; | 
|  | /* create the instance */ | 
|  | return device_create_instance(me, device_specifier, spec.last_args); | 
|  | } | 
|  |  | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (device *) | 
|  | tree_find_device(device *root, | 
|  | const char *path_to_device) | 
|  | { | 
|  | device *node; | 
|  | name_specifier spec; | 
|  |  | 
|  | /* parse the path */ | 
|  | split_device_specifier(root, path_to_device, &spec); | 
|  | if (spec.value != NULL) | 
|  | return NULL; /* something wierd */ | 
|  |  | 
|  | /* now find it */ | 
|  | node = split_find_device(root, &spec); | 
|  | if (spec.name != NULL) | 
|  | return NULL; /* not a leaf */ | 
|  |  | 
|  | return node; | 
|  | } | 
|  |  | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (const device_property *) | 
|  | tree_find_property(device *root, | 
|  | const char *path_to_property) | 
|  | { | 
|  | name_specifier spec; | 
|  | if (!split_property_specifier(root, path_to_property, &spec)) | 
|  | device_error(root, "Invalid property path %s", path_to_property); | 
|  | root = split_find_device(root, &spec); | 
|  | return device_find_property(root, spec.property); | 
|  | } | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (int) | 
|  | tree_find_boolean_property(device *root, | 
|  | const char *path_to_property) | 
|  | { | 
|  | name_specifier spec; | 
|  | if (!split_property_specifier(root, path_to_property, &spec)) | 
|  | device_error(root, "Invalid property path %s", path_to_property); | 
|  | root = split_find_device(root, &spec); | 
|  | return device_find_boolean_property(root, spec.property); | 
|  | } | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (signed_cell) | 
|  | tree_find_integer_property(device *root, | 
|  | const char *path_to_property) | 
|  | { | 
|  | name_specifier spec; | 
|  | if (!split_property_specifier(root, path_to_property, &spec)) | 
|  | device_error(root, "Invalid property path %s", path_to_property); | 
|  | root = split_find_device(root, &spec); | 
|  | return device_find_integer_property(root, spec.property); | 
|  | } | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (device_instance *) | 
|  | tree_find_ihandle_property(device *root, | 
|  | const char *path_to_property) | 
|  | { | 
|  | name_specifier spec; | 
|  | if (!split_property_specifier(root, path_to_property, &spec)) | 
|  | device_error(root, "Invalid property path %s", path_to_property); | 
|  | root = split_find_device(root, &spec); | 
|  | return device_find_ihandle_property(root, spec.property); | 
|  | } | 
|  |  | 
|  | INLINE_TREE\ | 
|  | (const char *) | 
|  | tree_find_string_property(device *root, | 
|  | const char *path_to_property) | 
|  | { | 
|  | name_specifier spec; | 
|  | if (!split_property_specifier(root, path_to_property, &spec)) | 
|  | device_error(root, "Invalid property path %s", path_to_property); | 
|  | root = split_find_device(root, &spec); | 
|  | return device_find_string_property(root, spec.property); | 
|  | } | 
|  |  | 
|  |  | 
|  | #endif /* _PARSE_C_ */ |