/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); |
} |
} |
} |