2 Copyright (C) 2012 Modelon AB
4 This program is free software: you can redistribute it and/or modify
5 it under the terms of the BSD style license.
7 This program is distributed in the hope that it will be useful,
8 but WITHOUT ANY WARRANTY; without even the implied warranty of
9 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 FMILIB_License.txt file for more details.
12 You should have received a copy of the FMILIB_License.txt file
13 along with this program. If not, contact Modelon AB <http://www.modelon.com>.
16 #include "fmi1_xml_model_description_impl.h"
17 #include "fmi1_xml_unit_impl.h"
19 static const char* module = "FMI1XML";
21 fmi1_xml_unit_t* fmi1_xml_get_unit(fmi1_xml_unit_definitions_t* ud, unsigned int index) {
22 if(index >= fmi1_xml_get_unit_definitions_number(ud)) return 0;
23 return jm_vector_get_item(jm_named_ptr)(&ud->definitions, index).ptr;
26 const char* fmi1_xml_get_unit_name(fmi1_xml_unit_t* u) {
30 unsigned int fmi1_xml_get_unit_display_unit_number(fmi1_xml_unit_t* u) {
31 return (unsigned int)jm_vector_get_size(jm_voidp)(&u->displayUnits);
34 fmi1_xml_display_unit_t* fmi1_xml_get_unit_display_unit(fmi1_xml_unit_t* u, size_t index) {
35 if(index >= fmi1_xml_get_unit_display_unit_number(u)) return 0;
36 return jm_vector_get_item(jm_voidp)(&u->displayUnits, index);
40 fmi1_xml_unit_t* fmi1_xml_get_base_unit(fmi1_xml_display_unit_t* du) {
44 const char* fmi1_xml_get_display_unit_name(fmi1_xml_display_unit_t* du) {
45 return du->displayUnit;
48 double fmi1_xml_get_display_unit_gain(fmi1_xml_display_unit_t* du) {
52 double fmi1_xml_get_display_unit_offset(fmi1_xml_display_unit_t* du) {
56 double fmi1_xml_convert_to_display_unit(double val , fmi1_xml_display_unit_t* du, int isRelativeQuantity) {
57 double gain = fmi1_xml_get_display_unit_gain(du);
58 double offset = fmi1_xml_get_display_unit_offset(du);
59 if(isRelativeQuantity)
62 return (val*gain + offset);
65 double fmi1_xml_convert_from_display_unit(double val, fmi1_xml_display_unit_t* du, int isRelativeQuantity) {
66 double gain = fmi1_xml_get_display_unit_gain(du);
67 double offset = fmi1_xml_get_display_unit_offset(du);
68 if(isRelativeQuantity)
71 return (val - offset)/gain;
74 int fmi1_xml_handle_UnitDefinitions(fmi1_xml_parser_context_t *context, const char* data) {
75 fmi1_xml_model_description_t* md = context->modelDescription;
77 jm_log_verbose(context->callbacks, module, "Parsing XML element UnitDefinitions");
80 jm_vector_qsort(jm_named_ptr)(&(md->unitDefinitions),jm_compare_named);
81 jm_vector_qsort(jm_named_ptr)(&(md->displayUnitDefinitions),jm_compare_named);
82 /* might give out a warning if(data[0] != 0) */
88 fmi1_xml_display_unit_t* fmi1_xml_get_parsed_unit(fmi1_xml_parser_context_t *context, jm_vector(char)* name, int sorted) {
89 fmi1_xml_unit_t dummy, *unit;
90 jm_named_ptr named, *pnamed;
91 fmi1_xml_model_description_t* md = context->modelDescription;
93 if(jm_vector_get_size(char)(name))
94 named.name = jm_vector_get_itemp(char)(name,0);
98 pnamed = jm_vector_bsearch(jm_named_ptr)(&(md->unitDefinitions), &named,jm_compare_named);
100 pnamed = jm_vector_find(jm_named_ptr)(&(md->unitDefinitions), &named,jm_compare_named);
104 return &unit->defaultDisplay;
108 pnamed = jm_vector_push_back(jm_named_ptr)(&(md->unitDefinitions),named);
109 if(pnamed) *pnamed = named = jm_named_alloc_v(name,sizeof(fmi1_xml_unit_t),dummy.baseUnit - (char*)&dummy,context->callbacks);
111 if(!pnamed || !named.ptr) {
112 fmi1_xml_parse_fatal(context, "Could not allocate memory");
117 unit->defaultDisplay.baseUnit = unit;
118 unit->defaultDisplay.offset = 0;
119 unit->defaultDisplay.gain = 1.0;
120 unit->defaultDisplay.displayUnit[0] = 0;
121 jm_vector_init(jm_voidp)(&(unit->displayUnits),0,context->callbacks);
123 if(sorted) jm_vector_qsort_jm_named_ptr(&(md->unitDefinitions), jm_compare_named);
124 return &unit->defaultDisplay;
127 int fmi1_xml_handle_BaseUnit(fmi1_xml_parser_context_t *context, const char* data) {
129 fmi1_xml_display_unit_t* unit;
130 jm_vector(char)* buf = fmi1_xml_reserve_parse_buffer(context,1,100);
133 if( /* <xs:attribute name="unit" type="xs:normalizedString" use="required"/> */
134 fmi1_xml_set_attr_string(context, fmi1_xml_elmID_BaseUnit, fmi_attr_id_unit, 1, buf) ||
135 !(unit = fmi1_xml_get_parsed_unit(context, buf, 0))
137 context->lastBaseUnit = unit->baseUnit;
140 /* don't do anything. might give out a warning if(data[0] != 0) */
146 int fmi1_xml_handle_DisplayUnitDefinition(fmi1_xml_parser_context_t *context, const char* data) {
148 fmi1_xml_model_description_t* md = context->modelDescription;
149 jm_vector(char)* buf = fmi1_xml_reserve_parse_buffer(context,1,100);
150 /* this display unit belongs to the last created base unit */
151 fmi1_xml_unit_t* unit = context->lastBaseUnit;
152 fmi1_xml_display_unit_t *dispUnit = 0;
153 fmi1_xml_display_unit_t dummyDU;
154 jm_named_ptr named, *pnamed;
158 /* first read the required name attribute */
159 /* <xs:attribute name="displayUnit" type="xs:normalizedString" use="required"/> */
160 ret = fmi1_xml_set_attr_string(context, fmi1_xml_elmID_DisplayUnitDefinition, fmi_attr_id_displayUnit, 1, buf);
162 /* alloc memory to the correct size and put display unit on the list for the base unit */
164 pnamed = jm_vector_push_back(jm_named_ptr)(&(md->displayUnitDefinitions),named);
165 if(pnamed) *pnamed = jm_named_alloc(jm_vector_get_itemp_char(buf,0),sizeof(fmi1_xml_display_unit_t), dummyDU.displayUnit - (char*)&dummyDU,context->callbacks);
166 dispUnit = pnamed->ptr;
167 if( !pnamed || !dispUnit ||
168 !jm_vector_push_back(jm_voidp)(&unit->displayUnits, dispUnit) ) {
169 fmi1_xml_parse_fatal(context, "Could not allocate memory");
172 dispUnit->baseUnit = unit;
173 /* finally process the attributes */
175 /* <xs:attribute name="gain" type="xs:double" default="1"/> */
176 fmi1_xml_set_attr_double(context, fmi1_xml_elmID_DisplayUnitDefinition, fmi_attr_id_gain, 0, &dispUnit->gain, 1) ||
177 /* <xs:attribute name="offset" type="xs:double" default="0"/> */
178 fmi1_xml_set_attr_double(context, fmi1_xml_elmID_DisplayUnitDefinition, fmi_attr_id_offset, 0, &dispUnit->offset, 0)
182 /* don't do anything. might give out a warning if(data[0] != 0) */