Rev 1570 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1570 | Rev 1573 | ||
---|---|---|---|
1 | package dongfang.mkt.main; |
1 | package dongfang.mkt.main; |
2 | 2 | ||
3 | import java.io.FileInputStream; |
3 | import java.io.FileInputStream; |
4 | import java.io.FileWriter; |
4 | import java.io.FileWriter; |
5 | import java.io.IOException; |
5 | import java.io.IOException; |
6 | import java.io.InputStream; |
6 | import java.io.InputStream; |
7 | 7 | ||
8 | import javax.xml.parsers.DocumentBuilder; |
8 | import javax.xml.parsers.DocumentBuilder; |
9 | import javax.xml.parsers.DocumentBuilderFactory; |
9 | import javax.xml.parsers.DocumentBuilderFactory; |
10 | import javax.xml.parsers.ParserConfigurationException; |
10 | import javax.xml.parsers.ParserConfigurationException; |
11 | import javax.xml.xpath.XPath; |
11 | import javax.xml.xpath.XPath; |
12 | import javax.xml.xpath.XPathConstants; |
12 | import javax.xml.xpath.XPathConstants; |
13 | import javax.xml.xpath.XPathExpressionException; |
13 | import javax.xml.xpath.XPathExpressionException; |
14 | import javax.xml.xpath.XPathFactory; |
14 | import javax.xml.xpath.XPathFactory; |
15 | 15 | ||
16 | import org.w3c.dom.Document; |
16 | import org.w3c.dom.Document; |
17 | import org.w3c.dom.Element; |
17 | import org.w3c.dom.Element; |
18 | import org.w3c.dom.NodeList; |
18 | import org.w3c.dom.NodeList; |
19 | import org.xml.sax.SAXException; |
19 | import org.xml.sax.SAXException; |
20 | 20 | ||
21 | import dongfang.mkt.comm.FrameQueue; |
21 | import dongfang.mkt.comm.FrameQueue; |
22 | import dongfang.mkt.comm.MKConnection; |
22 | import dongfang.mkt.comm.MKConnection; |
23 | import dongfang.mkt.comm.serial.RXTXSerialPort; |
23 | import dongfang.mkt.comm.serial.RXTXSerialPort; |
24 | import dongfang.mkt.comm.tcp.MKTCPConnection; |
- | |
25 | import dongfang.mkt.configuration.ConfigSet; |
24 | import dongfang.mkt.configuration.ConfigSet; |
26 | import dongfang.mkt.frames.UniversalReadParamSetRequestFrame; |
25 | import dongfang.mkt.frames.UniversalReadParamSetRequestFrame; |
27 | import dongfang.mkt.frames.UniversalReadParamSetResponseFrame; |
26 | import dongfang.mkt.frames.UniversalReadParamSetResponseFrame; |
28 | import dongfang.mkt.frames.UniversalWriteParamSetRequestFrame; |
27 | import dongfang.mkt.frames.UniversalWriteParamSetRequestFrame; |
29 | import dongfang.mkt.frames.UniversalWriteParamSetResponseFrame; |
28 | import dongfang.mkt.frames.UniversalWriteParamSetResponseFrame; |
30 | 29 | ||
31 | public class UniversalConfigurator { |
30 | public class UniversalConfigurator { |
32 | private static void configure(String portIdentifier, UniversalWriteParamSetRequestFrame frame, |
31 | private static void configure(String portIdentifier, UniversalWriteParamSetRequestFrame frame, |
33 | int parameterSetNumber) throws IOException { |
32 | int parameterSetNumber) throws IOException { |
34 | MKConnection port = new RXTXSerialPort(); |
33 | MKConnection port = new RXTXSerialPort(); |
35 | port.init(portIdentifier); |
34 | port.init(portIdentifier); |
36 | FrameQueue q = new FrameQueue(port); |
35 | FrameQueue q = new FrameQueue(port); |
37 | 36 | ||
38 | frame.setConfigurationSetNumber(parameterSetNumber); |
37 | frame.setConfigurationSetNumber(parameterSetNumber); |
39 | 38 | ||
40 | q.sendRequest(frame); |
39 | q.sendRequest(frame); |
41 | UniversalWriteParamSetResponseFrame r = (UniversalWriteParamSetResponseFrame) q |
40 | UniversalWriteParamSetResponseFrame r = (UniversalWriteParamSetResponseFrame) q.getResponseFor(frame, 5000); |
42 | .getResponseFor(frame, 5000); |
- | |
43 | if (r == null) { |
41 | if (r == null) { |
44 | System.err.println("ERROR. Timeout waiting for response."); |
42 | System.err.println("ERROR. Timeout waiting for response."); |
45 | } else if (!r.wasAccepted()) { |
43 | } else if (!r.wasAccepted()) { |
46 | System.err |
44 | System.err |
47 | .println("ERROR. Parameter set not accepted. Check version against MK firmware EEPROM configuration version and checkparameter set number"); |
45 | .println("ERROR. Parameter set not accepted. Check version against MK firmware EEPROM configuration version and checkparameter set number"); |
48 | } else { |
46 | } else { |
49 | System.out.println("Saved parameter set #" |
47 | System.out.println("Saved parameter set #" |
50 | + r.getParameterSetNumber() + "."); |
48 | + r.getParameterSetNumber() + "."); |
51 | } |
49 | } |
52 | 50 | ||
53 | q.kill(); |
51 | q.kill(); |
54 | } |
52 | } |
55 | 53 | ||
56 | private static void writeConfiguration(String portIdentifier, String s_parameterSetNumber, |
54 | private static void writeConfiguration(String portIdentifier, String s_parameterSetNumber, |
57 | String fileName) throws IOException { |
55 | String fileName) throws IOException { |
58 | System.out.println("Writing parameter set #" + s_parameterSetNumber + " from file: " + fileName); |
56 | System.out.println("Writing parameter set #" + s_parameterSetNumber + " from file: " + fileName); |
59 | int parameterSetNumber = Integer.parseInt(s_parameterSetNumber); |
57 | int parameterSetNumber = Integer.parseInt(s_parameterSetNumber); |
60 | InputStream inputStream = new FileInputStream(fileName); |
58 | InputStream inputStream = new FileInputStream(fileName); |
61 | UniversalWriteParamSetRequestFrame frame = parseXMLParameterSet(inputStream); |
59 | UniversalWriteParamSetRequestFrame frame = parseXMLParameterSet(inputStream); |
62 | configure(portIdentifier, frame, parameterSetNumber); |
60 | configure(portIdentifier, frame, parameterSetNumber); |
63 | } |
61 | } |
64 | 62 | ||
65 | private static ConfigSet readConfiguration(String portIdentifier, int parameterSetNumber) throws IOException { |
63 | private static ConfigSet readConfiguration(String portIdentifier, String s_parameterSetNumber) throws IOException { |
66 | MKConnection port = new RXTXSerialPort(); |
64 | MKConnection port = new RXTXSerialPort(); |
67 | port.init(portIdentifier); |
65 | port.init(portIdentifier); |
68 | FrameQueue q = new FrameQueue(port); |
66 | FrameQueue q = new FrameQueue(port); |
69 | ConfigSet cs = null; |
67 | ConfigSet cs = null; |
- | 68 | int parameterSetNumber = Integer.parseInt(s_parameterSetNumber); |
|
70 | 69 | ||
71 | UniversalReadParamSetRequestFrame frame = new UniversalReadParamSetRequestFrame(); |
70 | UniversalReadParamSetRequestFrame frame = new UniversalReadParamSetRequestFrame(); |
72 | frame.setConfigurationSetNumber(parameterSetNumber); |
71 | frame.setConfigurationSetNumber(parameterSetNumber); |
73 | q.sendRequest(frame); |
72 | q.sendRequest(frame); |
74 | UniversalReadParamSetResponseFrame r = (UniversalReadParamSetResponseFrame) q.getResponseFor(frame, 5000); |
73 | UniversalReadParamSetResponseFrame r = (UniversalReadParamSetResponseFrame) q.getResponseFor(frame, 5000); |
75 | if (r == null) { |
74 | if (r == null) { |
76 | System.err.println("ERROR. Timeout waiting for response."); |
75 | System.err.println("ERROR. Timeout waiting for response."); |
77 | } else { |
76 | } else { |
78 | int paramSetVersion = r.getConfigurationVersion(); |
77 | int paramSetVersion = r.getConfigurationVersion(); |
79 | int[] data = r.getData(); |
78 | int[] data = r.getData(); |
80 | cs = ConfigSet.parseXMLConfigSet(paramSetVersion); |
79 | cs = ConfigSet.parseXMLConfigSet(paramSetVersion); |
81 | cs.setData(data); |
80 | cs.setData(data); |
82 | System.out.println(cs.toXML()); |
81 | System.out.println(cs.toXML()); |
83 | } |
82 | } |
84 | q.kill(); |
83 | q.kill(); |
85 | return cs; |
84 | return cs; |
86 | } |
85 | } |
87 | 86 | ||
88 | /* |
87 | /* |
89 | private static ConfigSet simpleReadConfiguration(int parameterSetNumber) |
88 | private static ConfigSet simpleReadConfiguration(int parameterSetNumber) |
90 | throws IOException { |
89 | throws IOException { |
91 | MKCommPort port = new RXTXSerialPort(); |
90 | MKCommPort port = new RXTXSerialPort(); |
92 | port.init(null); |
91 | port.init(null); |
93 | FrameQueue q = new FrameQueue(port); |
92 | FrameQueue q = new FrameQueue(port); |
94 | ConfigSet cs = null; |
93 | ConfigSet cs = null; |
95 | 94 | ||
96 | UniversalReadParamSetRequestFrame frame = new UniversalReadParamSetRequestFrame(); |
95 | UniversalReadParamSetRequestFrame frame = new UniversalReadParamSetRequestFrame(); |
97 | frame.setConfigurationSetNumber(parameterSetNumber); |
96 | frame.setConfigurationSetNumber(parameterSetNumber); |
98 | q.sendRequest(frame); |
97 | q.sendRequest(frame); |
99 | UniversalReadParamSetResponseFrame r = (UniversalReadParamSetResponseFrame) q |
98 | UniversalReadParamSetResponseFrame r = (UniversalReadParamSetResponseFrame) q |
100 | .getResponseFor(frame, 3000); |
99 | .getResponseFor(frame, 3000); |
101 | if (r == null) { |
100 | if (r == null) { |
102 | System.err.println("ERROR. Timeout waiting for response."); |
101 | System.err.println("ERROR. Timeout waiting for response."); |
103 | } else { |
102 | } else { |
104 | int paramSetVersion = r.getConfigurationVersion(); |
103 | int paramSetVersion = r.getConfigurationVersion(); |
105 | int[] data = r.getData(); |
104 | int[] data = r.getData(); |
106 | for (int i=0; i<data.length; i++) |
105 | for (int i=0; i<data.length; i++) |
107 | System.out.println(data[i]); |
106 | System.out.println(data[i]); |
108 | } |
107 | } |
109 | q.kill(); |
108 | q.kill(); |
110 | return cs; |
109 | return cs; |
111 | } |
110 | } |
112 | */ |
111 | */ |
113 | 112 | ||
114 | private static void readConfiguration(String portIdentifier, String s_parameterSetNumber, String fileName) throws IOException { |
113 | private static void readConfiguration(String portIdentifier, String s_parameterSetNumber, String fileName) throws IOException { |
115 | int parameterSetNumber = Integer.parseInt(s_parameterSetNumber); |
- | |
116 | ConfigSet cs = readConfiguration(portIdentifier, parameterSetNumber); |
114 | ConfigSet cs = readConfiguration(portIdentifier, s_parameterSetNumber); |
117 | if (cs != null) { |
115 | if (cs != null) { |
118 | FileWriter fw = new FileWriter(fileName); |
116 | FileWriter fw = new FileWriter(fileName); |
119 | fw.write(cs.toXML()); |
117 | fw.write(cs.toXML()); |
120 | fw.close(); |
118 | fw.close(); |
121 | } |
119 | } |
122 | } |
120 | } |
123 | 121 | ||
124 | private static int substituteVariables(String s_value) { |
122 | private static int substituteVariables(String s_value) { |
125 | int numberOfHighestVar = 255; |
123 | int numberOfHighestVar = 255; |
126 | int numberOfLowestVar = numberOfHighestVar |
124 | int numberOfLowestVar = numberOfHighestVar |
127 | - ConfigSet.NUMBER_OF_VARIABLES; |
125 | - ConfigSet.NUMBER_OF_VARIABLES; |
128 | for (int i = 0; i < ConfigSet.NUMBER_OF_VARIABLES; i++) { |
126 | for (int i = 0; i < ConfigSet.NUMBER_OF_VARIABLES; i++) { |
129 | String varName = "var" + i; |
127 | String varName = "var" + i; |
130 | if (varName.equals(s_value)) { |
128 | if (varName.equals(s_value)) { |
131 | System.out.println("Substing: " + s_value + "-->" |
129 | System.out.println("Substing: " + s_value + "-->" |
132 | + (numberOfLowestVar + i)); |
130 | + (numberOfLowestVar + i)); |
133 | return numberOfLowestVar + i; |
131 | return numberOfLowestVar + i; |
134 | } |
132 | } |
135 | } |
133 | } |
136 | return -1; |
134 | return -1; |
137 | } |
135 | } |
138 | 136 | ||
139 | private static UniversalWriteParamSetRequestFrame parseXMLParameterSet( |
137 | private static UniversalWriteParamSetRequestFrame parseXMLParameterSet( |
140 | InputStream input) throws IOException { |
138 | InputStream input) throws IOException { |
141 | DocumentBuilderFactory saxfac = DocumentBuilderFactory.newInstance(); |
139 | DocumentBuilderFactory saxfac = DocumentBuilderFactory.newInstance(); |
142 | saxfac.setValidating(false); |
140 | saxfac.setValidating(false); |
143 | try { |
141 | try { |
144 | DocumentBuilder bldr = saxfac.newDocumentBuilder(); |
142 | DocumentBuilder bldr = saxfac.newDocumentBuilder(); |
145 | Document doc = bldr.parse(input); |
143 | Document doc = bldr.parse(input); |
146 | 144 | ||
147 | XPath xpath = XPathFactory.newInstance().newXPath(); |
145 | XPath xpath = XPathFactory.newInstance().newXPath(); |
148 | 146 | ||
149 | String s_eepromVersion = xpath.evaluate( |
147 | String s_eepromVersion = xpath.evaluate( |
150 | "/parameterset/@eepromVersion", doc); |
148 | "/parameterset/@eepromVersion", doc); |
151 | String ss_length = xpath.evaluate("/parameterset/@length", doc); |
149 | String ss_length = xpath.evaluate("/parameterset/@length", doc); |
152 | 150 | ||
153 | int s_length = 0; |
151 | int s_length = 0; |
154 | try { |
152 | try { |
155 | s_length = Integer.parseInt(ss_length); |
153 | s_length = Integer.parseInt(ss_length); |
156 | } catch (NumberFormatException ex) { |
154 | } catch (NumberFormatException ex) { |
157 | // ignore. |
155 | // ignore. |
158 | } |
156 | } |
159 | 157 | ||
160 | int eepromVersion = -1; |
158 | int eepromVersion = -1; |
161 | 159 | ||
162 | try { |
160 | try { |
163 | eepromVersion = Integer.parseInt(s_eepromVersion); |
161 | eepromVersion = Integer.parseInt(s_eepromVersion); |
164 | } catch (NumberFormatException ex) { |
162 | } catch (NumberFormatException ex) { |
165 | System.err |
163 | System.err |
166 | .println("The parameterset element must have an 'eepromVersion' attribute with a numerical value (eg.<parameterset eepromVersion='74'>)"); |
164 | .println("The parameterset element must have an 'eepromVersion' attribute with a numerical value (eg.<parameterset eepromVersion='74'>)"); |
167 | System.exit(-1); |
165 | System.exit(-1); |
168 | } |
166 | } |
169 | 167 | ||
170 | // if (s_length != null) |
168 | // if (s_length != null) |
171 | // try { |
169 | // try { |
172 | // length = Integer.parseInt(s_length); |
170 | // length = Integer.parseInt(s_length); |
173 | // } catch (NumberFormatException ex) { |
171 | // } catch (NumberFormatException ex) { |
174 | // System.err.println("The length attribute of the parameterset must have a numerical value"); |
172 | // System.err.println("The length attribute of the parameterset must have a numerical value"); |
175 | // System.exit(-1); |
173 | // System.exit(-1); |
176 | // } |
174 | // } |
177 | 175 | ||
178 | NodeList parameterNodes = (NodeList) xpath.evaluate( |
176 | NodeList parameterNodes = (NodeList) xpath.evaluate( |
179 | "/parameterset/parameter", doc, XPathConstants.NODESET); |
177 | "/parameterset/parameter", doc, XPathConstants.NODESET); |
180 | int[] parameters = new int[parameterNodes.getLength()]; |
178 | int[] parameters = new int[parameterNodes.getLength()]; |
- | 179 | ||
- | 180 | NodeList allChildNodes = (NodeList) xpath.evaluate( |
|
- | 181 | "/parameterset/*", doc, XPathConstants.NODESET); |
|
- | 182 | ||
- | 183 | if (parameterNodes.getLength() != allChildNodes.getLength()) { |
|
- | 184 | System.err.println("There seems to be a child element of parameterset whose name is not \"parameter\"."); |
|
- | 185 | // System.exit(-1); |
|
- | 186 | } |
|
181 | 187 | ||
182 | if (s_length >=0 && s_length != parameterNodes.getLength()) { |
188 | if (s_length >=0 && s_length != parameterNodes.getLength()) { |
183 | System.err.println("The number of parameters ("+parameterNodes.getLength()+") does not match the number in the length attribute of the parameterset element ("+s_length+")."); |
189 | System.err.println("The number of parameters ("+parameterNodes.getLength()+") does not match the number in the length attribute of the parameterset element ("+s_length+")."); |
184 | // System.exit(-1); |
190 | // System.exit(-1); |
185 | } |
191 | } |
186 | 192 | ||
187 | for (int i = 0; i < parameterNodes.getLength(); i++) { |
193 | for (int i = 0; i < parameterNodes.getLength(); i++) { |
188 | Element e = (Element) parameterNodes.item(i); |
194 | Element e = (Element) parameterNodes.item(i); |
189 | int value = 0; |
195 | int value = 0; |
190 | if (e.hasAttribute("value")) { |
196 | if (e.hasAttribute("value")) { |
191 | String s_value = e.getAttribute("value"); |
197 | String s_value = e.getAttribute("value"); |
192 | value = substituteVariables(s_value); |
198 | value = substituteVariables(s_value); |
193 | if (value < 0) |
199 | if (value < 0) |
194 | try { |
200 | try { |
195 | value = Integer.parseInt(s_value); |
201 | value = Integer.parseInt(s_value); |
196 | } catch (NumberFormatException ex) { |
202 | } catch (NumberFormatException ex) { |
197 | throw new NumberFormatException( |
203 | throw new NumberFormatException( |
198 | "Value is not a number and not a variable name."); |
204 | "Value is not a number and not a variable name."); |
199 | } |
205 | } |
200 | } else { |
206 | } else { |
201 | NodeList bitNodes = (NodeList) xpath.evaluate("bit", e, |
207 | NodeList bitNodes = (NodeList) xpath.evaluate("bit", e, |
202 | XPathConstants.NODESET); |
208 | XPathConstants.NODESET); |
203 | for (int j = 0; j < 8; j++) { |
209 | for (int j = 0; j < 8; j++) { |
204 | Element bitElement = (Element) bitNodes.item(j); |
210 | Element bitElement = (Element) bitNodes.item(j); |
205 | if (bitElement != null) { |
211 | if (bitElement != null) { |
206 | String s_bitValue = bitElement |
212 | String s_bitValue = bitElement |
207 | .getAttribute("value"); |
213 | .getAttribute("value"); |
208 | if ("1".equals(s_bitValue)) |
214 | if ("1".equals(s_bitValue)) |
209 | value |= (1 << j); |
215 | value |= (1 << j); |
210 | else if (!"0".equals(s_bitValue)) |
216 | else if (!"0".equals(s_bitValue)) |
211 | throw new NumberFormatException( |
217 | throw new NumberFormatException( |
212 | "Bit value was not 0 or 1."); |
218 | "Bit value was not 0 or 1."); |
213 | } |
219 | } |
214 | } |
220 | } |
215 | } |
221 | } |
216 | parameters[i] = value; |
222 | parameters[i] = value; |
217 | } |
223 | } |
218 | input.close(); |
224 | input.close(); |
219 | return new UniversalWriteParamSetRequestFrame(eepromVersion, |
225 | return new UniversalWriteParamSetRequestFrame(eepromVersion, "01234567890ab".toCharArray(), parameters); |
220 | parameters); |
- | |
221 | } catch (ParserConfigurationException ex) { |
226 | } catch (ParserConfigurationException ex) { |
222 | // Should never happen. |
227 | // Should never happen. |
223 | throw new RuntimeException(ex); |
228 | throw new RuntimeException(ex); |
224 | } catch (SAXException ex) { |
229 | } catch (SAXException ex) { |
225 | System.err.println(ex); |
230 | System.err.println(ex); |
226 | System.err |
231 | System.err |
227 | .println("There is something screwed with your XML document. It is not well-formed and won't parse."); |
232 | .println("There is something screwed with your XML document. It is not well-formed and won't parse."); |
228 | throw new RuntimeException("Parse error."); |
233 | throw new RuntimeException("Parse error."); |
229 | } catch (XPathExpressionException ex) { |
234 | } catch (XPathExpressionException ex) { |
230 | // Should never happen. |
235 | // Should never happen. |
231 | throw new RuntimeException(ex); |
236 | throw new RuntimeException(ex); |
232 | } |
237 | } |
233 | } |
238 | } |
234 | 239 | ||
235 | static void help() { |
240 | static void help() { |
236 | System.err |
241 | System.err |
237 | .println("Usage: UniversalConfigurator r [parameter set number to read from] [filename to write to]"); |
242 | .println("Usage: UniversalConfigurator r [parameter set number to read from] [filename to write to]"); |
238 | System.err |
243 | System.err |
239 | .println("Usage: UniversalConfigurator w [parameter set number to write to] [filename to read from]"); |
244 | .println("Usage: UniversalConfigurator w [parameter set number to write to] [filename to read from]"); |
240 | System.exit(-1); |
245 | System.exit(-1); |
241 | } |
246 | } |
242 | 247 | ||
243 | public static void main(String[] args) throws IOException { |
248 | public static void main(String[] args) throws IOException { |
244 | if (!"r".equals(args[0]) && !"w".equals(args[0])) help(); |
249 | if (!"r".equals(args[0]) && !"w".equals(args[0])) help(); |
245 | if ("w".equals(args[0]) && (args.length!=3 && args.length!=4)) help(); |
250 | if ("w".equals(args[0]) && (args.length!=3 && args.length!=4)) help(); |
246 | if ("r".equals(args[0]) && (args.length!=3 && args.length!=4)) help(); |
251 | if ("r".equals(args[0]) && (args.length!=3 && args.length!=4)) help(); |
247 | 252 | ||
248 | String portIdentifier = null; |
253 | String portIdentifier = null; |
249 | 254 | ||
250 | if ("r".equals(args[0])) { |
255 | if ("r".equals(args[0])) { |
251 | readConfiguration(portIdentifier, Integer.parseInt(args[1])); |
256 | readConfiguration(portIdentifier, args[1]); |
252 | } else { |
257 | } else { |
253 | writeConfiguration(portIdentifier, args[1], args[2]); |
258 | writeConfiguration(portIdentifier, args[1], args[2]); |
254 | } |
259 | } |
255 | System.exit(0); |
260 | System.exit(0); |
256 | } |
261 | } |
257 | } |
262 | } |