/* * libiio - Library for interfacing industrial I/O (IIO) devices * * Copyright (C) 2014 Analog Devices, Inc. * Author: Paul Cercueil * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License as published by the Free Software Foundation; either * version 2.1 of the License, or (at your option) any later version. * * This library 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 * Lesser General Public License for more details. * * */ #include "debug.h" #include "iio-private.h" #include #include #include static int add_attr_to_channel(struct iio_channel *chn, xmlNode *n) { xmlAttr *attr; char *name = NULL, *filename = NULL; struct iio_channel_attr *attrs; for (attr = n->properties; attr; attr = attr->next) { if (!strcmp((char *) attr->name, "name")) { name = iio_strdup((char *) attr->children->content); } else if (!strcmp((char *) attr->name, "filename")) { filename = iio_strdup((char *) attr->children->content); } else { WARNING("Unknown field \'%s\' in channel %s\n", attr->name, chn->id); } } if (!name) { ERROR("Incomplete attribute in channel %s\n", chn->id); goto err_free; } if (!filename) { filename = iio_strdup(name); if (!filename) goto err_free; } attrs = realloc(chn->attrs, (1 + chn->nb_attrs) * sizeof(struct iio_channel_attr)); if (!attrs) goto err_free; attrs[chn->nb_attrs].filename = filename; attrs[chn->nb_attrs++].name = name; chn->attrs = attrs; return 0; err_free: if (name) free(name); if (filename) free(filename); return -1; } static int add_attr_to_device(struct iio_device *dev, xmlNode *n, enum iio_attr_type type) { xmlAttr *attr; char **attrs, *name = NULL; for (attr = n->properties; attr; attr = attr->next) { if (!strcmp((char *) attr->name, "name")) { name = iio_strdup((char *) attr->children->content); } else { WARNING("Unknown field \'%s\' in device %s\n", attr->name, dev->id); } } if (!name) { ERROR("Incomplete attribute in device %s\n", dev->id); goto err_free; } switch(type) { case IIO_ATTR_TYPE_DEBUG: attrs = realloc(dev->debug_attrs, (1 + dev->nb_debug_attrs) * sizeof(char *)); break; case IIO_ATTR_TYPE_DEVICE: attrs = realloc(dev->attrs, (1 + dev->nb_attrs) * sizeof(char *)); break; case IIO_ATTR_TYPE_BUFFER: attrs = realloc(dev->buffer_attrs, (1 + dev->nb_buffer_attrs) * sizeof(char *)); break; default: attrs = NULL; break; } if (!attrs) goto err_free; switch(type) { case IIO_ATTR_TYPE_DEBUG: attrs[dev->nb_debug_attrs++] = name; dev->debug_attrs = attrs; break; case IIO_ATTR_TYPE_DEVICE: attrs[dev->nb_attrs++] = name; dev->attrs = attrs; break; case IIO_ATTR_TYPE_BUFFER: attrs[dev->nb_buffer_attrs++] = name; dev->buffer_attrs = attrs; break; } return 0; err_free: if (name) free(name); return -1; } static void setup_scan_element(struct iio_channel *chn, xmlNode *n) { xmlAttr *attr; for (attr = n->properties; attr; attr = attr->next) { const char *name = (const char *) attr->name, *content = (const char *) attr->children->content; if (!strcmp(name, "index")) { chn->index = atol(content); } else if (!strcmp(name, "format")) { char e, s; if (strchr(content, 'X')) { sscanf(content, "%ce:%c%u/%uX%u>>%u", &e, &s, &chn->format.bits, &chn->format.length, &chn->format.repeat, &chn->format.shift); } else { chn->format.repeat = 1; sscanf(content, "%ce:%c%u/%u>>%u", &e, &s, &chn->format.bits, &chn->format.length, &chn->format.shift); } chn->format.is_be = e == 'b'; chn->format.is_signed = (s == 's' || s == 'S'); chn->format.is_fully_defined = (s == 'S' || s == 'U' || chn->format.bits == chn->format.length); } else if (!strcmp(name, "scale")) { chn->format.with_scale = true; chn->format.scale = atof(content); } else { WARNING("Unknown attribute \'%s\' in \n", name); } } } static struct iio_channel * create_channel(struct iio_device *dev, xmlNode *n) { xmlAttr *attr; struct iio_channel *chn = zalloc(sizeof(*chn)); if (!chn) return NULL; chn->dev = dev; /* Set the default index value < 0 (== no index) */ chn->index = -ENOENT; for (attr = n->properties; attr; attr = attr->next) { const char *name = (const char *) attr->name, *content = (const char *) attr->children->content; if (!strcmp(name, "name")) { chn->name = iio_strdup(content); } else if (!strcmp(name, "id")) { chn->id = iio_strdup(content); } else if (!strcmp(name, "type")) { if (!strcmp(content, "output")) chn->is_output = true; else if (strcmp(content, "input")) WARNING("Unknown channel type %s\n", content); } else { WARNING("Unknown attribute \'%s\' in \n", name); } } if (!chn->id) { ERROR("Incomplete \n"); goto err_free_channel; } for (n = n->children; n; n = n->next) { if (!strcmp((char *) n->name, "attribute")) { if (add_attr_to_channel(chn, n) < 0) goto err_free_channel; } else if (!strcmp((char *) n->name, "scan-element")) { chn->is_scan_element = true; setup_scan_element(chn, n); } else if (strcmp((char *) n->name, "text")) { WARNING("Unknown children \'%s\' in \n", n->name); continue; } } iio_channel_init_finalize(chn); return chn; err_free_channel: free_channel(chn); return NULL; } static struct iio_device * create_device(struct iio_context *ctx, xmlNode *n) { xmlAttr *attr; struct iio_device *dev = zalloc(sizeof(*dev)); if (!dev) return NULL; dev->ctx = ctx; for (attr = n->properties; attr; attr = attr->next) { if (!strcmp((char *) attr->name, "name")) { dev->name = iio_strdup( (char *) attr->children->content); } else if (!strcmp((char *) attr->name, "id")) { dev->id = iio_strdup((char *) attr->children->content); } else { WARNING("Unknown attribute \'%s\' in \n", attr->name); } } if (!dev->id) { ERROR("Unable to read device ID\n"); goto err_free_device; } for (n = n->children; n; n = n->next) { if (!strcmp((char *) n->name, "channel")) { struct iio_channel **chns, *chn = create_channel(dev, n); if (!chn) { ERROR("Unable to create channel\n"); goto err_free_device; } chns = realloc(dev->channels, (1 + dev->nb_channels) * sizeof(struct iio_channel *)); if (!chns) { ERROR("Unable to allocate memory\n"); free(chn); goto err_free_device; } chns[dev->nb_channels++] = chn; dev->channels = chns; } else if (!strcmp((char *) n->name, "attribute")) { if (add_attr_to_device(dev, n, IIO_ATTR_TYPE_DEVICE) < 0) goto err_free_device; } else if (!strcmp((char *) n->name, "debug-attribute")) { if (add_attr_to_device(dev, n, IIO_ATTR_TYPE_DEBUG) < 0) goto err_free_device; } else if (!strcmp((char *) n->name, "buffer-attribute")) { if (add_attr_to_device(dev, n, IIO_ATTR_TYPE_BUFFER) < 0) goto err_free_device; } else if (strcmp((char *) n->name, "text")) { WARNING("Unknown children \'%s\' in \n", n->name); continue; } } dev->words = (dev->nb_channels + 31) / 32; if (dev->words) { dev->mask = calloc(dev->words, sizeof(*dev->mask)); if (!dev->mask) { errno = ENOMEM; goto err_free_device; } } return dev; err_free_device: free_device(dev); return NULL; } static struct iio_context * xml_clone(const struct iio_context *ctx) { return xml_create_context_mem(ctx->xml, strlen(ctx->xml)); } static const struct iio_backend_ops xml_ops = { .clone = xml_clone, }; static int parse_context_attr(struct iio_context *ctx, xmlNode *n) { xmlAttr *attr; const char *name = NULL, *value = NULL; for (attr = n->properties; attr; attr = attr->next) { if (!strcmp((const char *) attr->name, "name")) { name = (const char *) attr->children->content; } else if (!strcmp((const char *) attr->name, "value")) { value = (const char *) attr->children->content; } } if (!name || !value) return -EINVAL; else return iio_context_add_attr(ctx, name, value); } static struct iio_context * iio_create_xml_context_helper(xmlDoc *doc) { unsigned int i; xmlNode *root, *n; xmlAttr *attr; int err = -ENOMEM; struct iio_context *ctx = zalloc(sizeof(*ctx)); if (!ctx) goto err_set_errno; ctx->name = "xml"; ctx->ops = &xml_ops; root = xmlDocGetRootElement(doc); if (strcmp((char *) root->name, "context")) { ERROR("Unrecognized XML file\n"); err = -EINVAL; goto err_free_ctx; } for (attr = root->properties; attr; attr = attr->next) { if (!strcmp((char *) attr->name, "description")) ctx->description = iio_strdup( (char *) attr->children->content); else if (strcmp((char *) attr->name, "name")) WARNING("Unknown parameter \'%s\' in \n", (char *) attr->children->content); } for (n = root->children; n; n = n->next) { struct iio_device **devs, *dev; if (!strcmp((char *) n->name, "context-attribute")) { err = parse_context_attr(ctx, n); if (err) goto err_free_devices; else continue; } else if (strcmp((char *) n->name, "device")) { if (strcmp((char *) n->name, "text")) WARNING("Unknown children \'%s\' in " "\n", n->name); continue; } dev = create_device(ctx, n); if (!dev) { ERROR("Unable to create device\n"); goto err_free_devices; } devs = realloc(ctx->devices, (1 + ctx->nb_devices) * sizeof(struct iio_device *)); if (!devs) { ERROR("Unable to allocate memory\n"); free(dev); goto err_free_devices; } devs[ctx->nb_devices++] = dev; ctx->devices = devs; } err = iio_context_init(ctx); if (err) goto err_free_devices; return ctx; err_free_devices: for (i = 0; i < ctx->nb_devices; i++) free_device(ctx->devices[i]); if (ctx->nb_devices) free(ctx->devices); for (i = 0; i < ctx->nb_attrs; i++) { free(ctx->attrs[i]); free(ctx->values[i]); } free(ctx->attrs); free(ctx->values); err_free_ctx: free(ctx); err_set_errno: errno = -err; return NULL; } struct iio_context * xml_create_context(const char *xml_file) { struct iio_context *ctx; xmlDoc *doc; LIBXML_TEST_VERSION; doc = xmlReadFile(xml_file, NULL, XML_PARSE_DTDVALID); if (!doc) { ERROR("Unable to parse XML file\n"); errno = EINVAL; return NULL; } ctx = iio_create_xml_context_helper(doc); xmlFreeDoc(doc); return ctx; } struct iio_context * xml_create_context_mem(const char *xml, size_t len) { struct iio_context *ctx; xmlDoc *doc; LIBXML_TEST_VERSION; doc = xmlReadMemory(xml, (int) len, NULL, NULL, XML_PARSE_DTDVALID); if (!doc) { ERROR("Unable to parse XML file\n"); errno = EINVAL; return NULL; } ctx = iio_create_xml_context_helper(doc); xmlFreeDoc(doc); return ctx; }