Subversion Repositories Projects

Compare Revisions

Ignore whitespace Rev 1610 → Rev 1611

/dongfang_FC_rewrite_tool/src/dongfang/mkt/configuration/ConfigSet.java
File deleted
\ No newline at end of file
/dongfang_FC_rewrite_tool/src/dongfang/mkt/configuration/ArrayEntry.java
0,0 → 1,46
package dongfang.mkt.configuration;
 
public class ArrayEntry extends ParameterEntry {
int length;
boolean isDynamic;
int[] values;
 
ArrayEntry(String name, boolean isDynamic, int length) {
super(name);
this.isDynamic = isDynamic;
this.length = length;
}
 
int[] getValue() {
return values;
}
 
int setValue(int[] data, int offset) {
values = new int[length];
System.arraycopy(data, offset, values, 0, length);
return length;
}
 
int getByteCount() {
return length;
}
 
String toStringWithValues() {
StringBuilder result = new StringBuilder(name + ":\t{");
for (int i = 0; i < length; i++) {
if (i != 0)
result.append(",");
result.append(values[i]);
}
result.append("}");
return result.toString();
}
 
void toXML(StringBuilder result) {
result.append(" <list name=\"" + name + "\">\n");
for (int i = 0; i < length; i++) {
result.append(" <entry value=\"" + values[i] + "\"/>\n");
}
result.append(" </list>\n");
}
}
/dongfang_FC_rewrite_tool/src/dongfang/mkt/configuration/BitSetEntry.java
0,0 → 1,44
package dongfang.mkt.configuration;
 
public class BitSetEntry extends ParameterEntry {
BitSetEntry(String name, String[] bitNames) {
super(name);
this.bitNames = bitNames;
}
 
int value;
String[] bitNames;
 
int getByteCount() {
return 1;
}
 
int getValue() {
return value;
}
 
int setValue(int[] data, int offset) {
value = data[offset];
return getByteCount();
}
 
String toStringWithValues() {
StringBuilder result = new StringBuilder(name + "\t[");
for (int i = 0; i < Math.min(bitNames.length, 8); i++) {
if (i != 0)
result.append(", ");
result.append(bitNames[i] + ":"
+ ((value & (1 << i)) != 0 ? "1" : "0"));
}
return result.toString();
}
 
void toXML(StringBuilder result) {
result.append(" <parameter name=\"" + name + "\">\n");
for (int i = 0; i < Math.min(bitNames.length, 8); i++) {
result.append(" <bit name=\"" + bitNames[i] + "\" value=\""
+ ((value & (1 << i)) != 0 ? "1" : "0") + "\"/>\n");
}
result.append(" </parameter>\n");
}
}
/dongfang_FC_rewrite_tool/src/dongfang/mkt/configuration/ConfigurationSet.java
0,0 → 1,82
package dongfang.mkt.configuration;
 
import java.io.IOException;
import java.util.ArrayList;
import java.util.List;
 
public abstract class ConfigurationSet {
public static final int NUMBER_OF_VARIABLES = 8;
 
protected int eepromVersion;
protected List<ParameterEntry> entries = new ArrayList<ParameterEntry>();
 
public ConfigurationSet() {
super();
}
 
public List<ParameterEntry> getEntries() {
return entries;
}
 
protected abstract int correctLengthToExcludeName(int length);
protected abstract void setName(int[] data, int offset);
protected abstract void outputName(StringBuilder sb);
public void setData(int[] data) throws IOException {
int offset = 0;
int dataLength = correctLengthToExcludeName(data.length);
if (dataLength != getByteCount()) {
throw new IOException("The received number of databytes (" + dataLength + ") was not equal to the length of the declared parameter set(" + getByteCount()+").");
}
for (ParameterEntry entry : entries) {
offset += entry.setValue(data, offset);
}
setName(data, offset);
}
 
public int getByteCount() {
int result = 0;
for (ParameterEntry e : entries) {
result += e.getByteCount();
}
return result;
}
 
public String toStringWithValues() {
StringBuilder result = new StringBuilder();
outputName(result);
for (ParameterEntry entry : entries) {
result.append(entry.toStringWithValues() + "\n");
}
return result.toString();
}
 
public String generateDynamicSubstitutionCode() {
StringBuilder result = new StringBuilder(
"const MMXLATION XLATIONS[] = {\n");
boolean hasEntries = false;
for (ParameterEntry entry : entries) {
if (entry instanceof DynamicByteEntry) {
if (hasEntries)
result.append(",\n");
else
hasEntries = true;
DynamicByteEntry de = (DynamicByteEntry) entry;
result.append("{offsetof(ParamSet_t, ");
result.append(de.getStaticCodeName());
result.append("), offsetof(DynamicParams_t, ");
result.append(de.getDynamicCodeName());
result.append("),");
result.append(Integer.toString(de.getMinValue()));
result.append(",");
result.append(Integer.toString(de.getMaxValue()));
result.append("}");
}
}
result.append("};");
return result.toString();
}
 
}
/dongfang_FC_rewrite_tool/src/dongfang/mkt/configuration/DynamicByteEntry.java
0,0 → 1,55
package dongfang.mkt.configuration;
 
public class DynamicByteEntry extends StaticByteEntry {
int minValue = 0;
int maxValue = 255;
String staticCodeName;
String dynamicCodeName;
DynamicByteEntry(String name) {
super(name);
}
 
int getMinValue() {
return minValue;
}
 
int getMaxValue() {
return maxValue;
}
 
void setMinValue(int minValue) {
this.minValue = minValue;
}
 
void setMaxValue(int maxValue) {
this.maxValue = maxValue;
}
 
String getStaticCodeName() {
return staticCodeName;
}
 
String getDynamicCodeName() {
return dynamicCodeName;
}
 
void setStaticCodeName(String staticCodeName) {
this.staticCodeName = staticCodeName;
}
 
void setDynamicCodeName(String dynamicCodeName) {
this.dynamicCodeName = dynamicCodeName;
}
 
void toXML(StringBuilder result) {
String s_value;
int numberOfLowestVariable = 256 - ParameterSet.NUMBER_OF_VARIABLES;
if (value >= numberOfLowestVariable) {
s_value = "var" + (value - numberOfLowestVariable);
} else
s_value = Integer.toString(value);
result.append(" <parameter name=\"" + name + "\" value=\""
+ s_value + "\"/>\n");
}
}
/dongfang_FC_rewrite_tool/src/dongfang/mkt/configuration/IMUConfiguration.java
0,0 → 1,138
package dongfang.mkt.configuration;
 
import java.io.File;
import java.io.IOException;
 
import javax.xml.parsers.DocumentBuilder;
import javax.xml.parsers.DocumentBuilderFactory;
import javax.xml.parsers.ParserConfigurationException;
import javax.xml.xpath.XPath;
import javax.xml.xpath.XPathConstants;
import javax.xml.xpath.XPathExpressionException;
import javax.xml.xpath.XPathFactory;
 
import org.w3c.dom.Document;
import org.w3c.dom.Element;
import org.w3c.dom.NodeList;
import org.xml.sax.SAXException;
 
public class IMUConfiguration extends ConfigurationSet {
protected int correctLengthToExcludeName(int length) {
return length;
}
protected void setName(int[] data, int length) {}
protected void outputName(StringBuilder sb) {
}
public String toXML() {
StringBuilder result = new StringBuilder();
result.append("<imuconfiguration eepromVersion=\"" + eepromVersion
+ "\" length=\"" + getByteCount() + "\">\n");
for (int i = 0; i < entries.size(); i++) {
ParameterEntry entry = entries.get(i);
entry.toXML(result);
}
result.append("</imuconfiguration>\n");
return result.toString();
}
 
public IMUConfiguration(int eepromVersion) {
super();
this.eepromVersion = eepromVersion;
}
 
// This parses only for the purpose of naming and typing parameter sets!
// It does not parse the section and default information, which could be
// useful for GUIs etc.
public static IMUConfiguration parseXMLIMUConfiguration(int version)
throws IOException {
String fileName = "configsets/templates/imuconfiguration_v" + version
+ ".xml";
File f = new File(fileName);
DocumentBuilderFactory saxfac = DocumentBuilderFactory.newInstance();
saxfac.setValidating(false);
try {
DocumentBuilder bldr = saxfac.newDocumentBuilder();
Document doc = bldr.parse(f);
XPath xpath = XPathFactory.newInstance().newXPath();
 
String s_eepromVersion = xpath.evaluate(
"/imuconfigurationtemplate/@eepromVersion", doc);
int eepromVersion = Integer.parseInt(s_eepromVersion);
 
String s_declaredLength = xpath.evaluate(
"/imuconfigurationtemplate/@length", doc);
int declaredLength = Integer.parseInt(s_declaredLength);
 
if (eepromVersion != version) {
throw new IOException(
"Version mismatch between file name ("
+ fileName
+ ") and the version in the imuconfigurationtemplate/@eepromVersion attribute("
+ s_eepromVersion + ")");
}
 
IMUConfiguration result = new IMUConfiguration(eepromVersion);
 
NodeList parameterNodes = (NodeList) xpath.evaluate(
"/imuconfigurationtemplate/parameter", doc,
XPathConstants.NODESET);
 
for (int j = 0; j < parameterNodes.getLength(); j++) {
Element parameterNode = (Element) parameterNodes.item(j);
 
ParameterEntry entry;
 
String s_name = parameterNode.getAttribute("name");
String s_type;
 
if (parameterNode.hasAttribute("type")) {
s_type = parameterNode.getAttribute("type");
} else {
s_type = "static";
}
 
if ("static".equals(s_type)) {
entry = new StaticByteEntry(s_name);
} else if ("dynamic".equals(s_type)) {
throw new IOException("Dynamic parameters are not supported in IMU config.");
} else if ("bitset".equals(s_type)) {
NodeList bitNodes = (NodeList) xpath.evaluate("bit",
parameterNode, XPathConstants.NODESET);
String[] bitNames = new String[8];
for (int k = 0; k < 8; k++) {
Element bitNode = (Element) bitNodes.item(k);
if (bitNode != null) {
bitNames[k] = bitNode.getAttribute("name");
} else {
bitNames[k] = "Unused";
}
}
entry = new BitSetEntry(s_name, bitNames);
} else {
throw new IOException("Unknown parameter type: " + s_type);
}
 
result.entries.add(entry);
}
//result.name = "" + version;
if (result.getByteCount() != declaredLength) {
throw new IOException("The number of parameters in the set ("
+ result.getEntries().size()
+ ") was not equal to the declared length ("
+ declaredLength + ").");
}
return result;
} catch (IOException ex) {
throw ex;
} catch (XPathExpressionException ex) {
throw new IOException(ex);
} catch (SAXException ex) {
throw new IOException(ex);
} catch (ParserConfigurationException ex) {
throw new IOException(ex);
}
}
}
/dongfang_FC_rewrite_tool/src/dongfang/mkt/configuration/ParameterEntry.java
0,0 → 1,25
package dongfang.mkt.configuration;
 
public abstract class ParameterEntry {
String name;
 
ParameterEntry(String name) {
this.name = name;
}
 
abstract int getByteCount();
 
abstract String toStringWithValues();
 
abstract void toXML(StringBuilder result);
 
abstract int setValue(int[] data, int offset);
 
public String getName() {
return name;
}
 
public String getSection() {
return name;
}
}
/dongfang_FC_rewrite_tool/src/dongfang/mkt/configuration/ParameterSection.java
0,0 → 1,31
package dongfang.mkt.configuration;
 
import java.util.ArrayList;
import java.util.List;
 
 
public class ParameterSection {
String name, title;
List<ParameterEntry> entries = new ArrayList<ParameterEntry>();
 
public ParameterSection(String name, String title) {
this.name = name;
this.title = title;
}
 
public void addConfigEntry(ParameterEntry e) {
this.entries.add(e);
}
 
public List<ParameterEntry> getEntries() {
return entries;
}
 
public String getName() {
return name;
}
 
public String getTitle() {
return title;
}
}
/dongfang_FC_rewrite_tool/src/dongfang/mkt/configuration/ParameterSet.java
0,0 → 1,195
package dongfang.mkt.configuration;
 
import java.io.File;
import java.io.IOException;
import java.util.ArrayList;
import java.util.List;
 
import javax.xml.parsers.DocumentBuilder;
import javax.xml.parsers.DocumentBuilderFactory;
import javax.xml.parsers.ParserConfigurationException;
import javax.xml.xpath.XPath;
import javax.xml.xpath.XPathConstants;
import javax.xml.xpath.XPathExpressionException;
import javax.xml.xpath.XPathFactory;
 
import org.w3c.dom.Document;
import org.w3c.dom.Element;
import org.w3c.dom.NodeList;
import org.xml.sax.SAXException;
 
public class ParameterSet extends ConfigurationSet {
public static final int NUMBER_OF_VARIABLES = 8;
List<ParameterSection> declaredSections = new ArrayList<ParameterSection>();
protected String name;
 
protected int correctLengthToExcludeName(int length) {
return length - 12;
}
 
protected void setName(int[] data) {
StringBuilder sbname = new StringBuilder();
for (int i = 0; i < 12; i++) {
if (data[offset] == 0)
break;
sbname.append((char) data[offset++]);
}
name = sbname.toString();
}
protected void outputName(StringBuilder sb) {
sb.append(name + "\n");
}
 
public List<ParameterSection> getDeclaredSections() {
return declaredSections;
}
 
public String toXML() {
StringBuilder result = new StringBuilder();
result.append("<parameterset eepromVersion=\"" + eepromVersion
+ "\" length=\"" + getByteCount() + "\">\n");
for (int i = 0; i < entries.size(); i++) {
ParameterEntry entry = entries.get(i);
entry.toXML(result);
}
result.append("</parameterset>\n");
return result.toString();
}
 
public ParameterSet(int eepromVersion) {
super();
this.eepromVersion = eepromVersion;
}
 
// This parses only for the purpose of naming and typing parameter sets!
// It does not parse the section and default information, which could be
// useful for GUIs etc.
public static ParameterSet parseXMLParameterSet(int version)
throws IOException {
String fileName = "configsets/templates/parameterset_v" + version
+ ".xml";
File f = new File(fileName);
DocumentBuilderFactory saxfac = DocumentBuilderFactory.newInstance();
saxfac.setValidating(false);
try {
DocumentBuilder bldr = saxfac.newDocumentBuilder();
Document doc = bldr.parse(f);
XPath xpath = XPathFactory.newInstance().newXPath();
 
String s_eepromVersion = xpath.evaluate(
"/parametertemplate/@eepromVersion", doc);
int eepromVersion = Integer.parseInt(s_eepromVersion);
 
String s_declaredLength = xpath.evaluate(
"/parametertemplate/@length", doc);
int declaredLength = Integer.parseInt(s_declaredLength);
 
if (eepromVersion != version) {
throw new IOException(
"Version mismatch between file name ("
+ fileName
+ ") and the version in the parametertemplate/@eepromVersion attribute("
+ s_eepromVersion + ")");
}
 
ParameterSet result = new ParameterSet(eepromVersion);
 
NodeList sectionNodes = (NodeList) xpath.evaluate(
"/parametertemplate/section", doc, XPathConstants.NODESET);
 
for (int i = 0; i < sectionNodes.getLength(); i++) {
Element sectionNode = (Element) sectionNodes.item(i);
ParameterSection section = new ParameterSection(
sectionNode.getAttribute("name"),
sectionNode.getAttribute("title"));
result.declaredSections.add(section);
 
NodeList parameterNodes = (NodeList) xpath.evaluate(
"parameter", sectionNode, XPathConstants.NODESET);
 
for (int j = 0; j < parameterNodes.getLength(); j++) {
Element parameterNode = (Element) parameterNodes.item(j);
 
ParameterEntry entry;
 
if (!sectionNode.hasAttribute("name")) {
throw new IOException("A parameter element (the " + j
+ "th in section "
+ sectionNode.getAttribute("name")
+ ") had no name attribute!");
}
 
String s_name = parameterNode.getAttribute("name");
String s_type;
 
if (parameterNode.hasAttribute("type")) {
s_type = parameterNode.getAttribute("type");
} else {
s_type = "static";
}
 
if ("static".equals(s_type)) {
entry = new StaticByteEntry(s_name);
} else if ("dynamic".equals(s_type)) {
DynamicByteEntry de = new DynamicByteEntry(s_name);
if (parameterNode.hasAttribute("minValue")) {
de.setMinValue(Integer.parseInt(parameterNode
.getAttribute("minValue")));
}
if (parameterNode.hasAttribute("maxValue")) {
de.setMinValue(Integer.parseInt(parameterNode
.getAttribute("maxValue")));
}
if (parameterNode.hasAttribute("staticCodeName")) {
de.setStaticCodeName(parameterNode
.getAttribute("staticCodeName"));
} else
de.setStaticCodeName(de.getName());
if (parameterNode.hasAttribute("dynamicCodeName")) {
de.setDynamicCodeName(parameterNode
.getAttribute("dynamicCodeName"));
} else
de.setDynamicCodeName(de.getName());
entry = de;
} else if ("bitset".equals(s_type)) {
NodeList bitNodes = (NodeList) xpath.evaluate("bit",
parameterNode, XPathConstants.NODESET);
String[] bitNames = new String[8];
for (int k = 0; k < 8; k++) {
Element bitNode = (Element) bitNodes.item(k);
if (bitNode != null) {
bitNames[k] = bitNode.getAttribute("name");
} else {
bitNames[k] = "Unused";
}
}
entry = new BitSetEntry(s_name, bitNames);
} else {
throw new IOException("Unknown parameter type: "
+ s_type);
}
 
result.entries.add(entry);
section.addConfigEntry(entry);
}
}
result.name = "" + version;
if (result.getByteCount() != declaredLength) {
throw new IOException("The number of parameters in the set ("
+ result.getEntries().size()
+ ") was not equal to the declared length ("
+ declaredLength + ").");
}
return result;
} catch (IOException ex) {
throw ex;
} catch (XPathExpressionException ex) {
throw new IOException(ex);
} catch (SAXException ex) {
throw new IOException(ex);
} catch (ParserConfigurationException ex) {
throw new IOException(ex);
}
}
}