Subversion Repositories Projects

Rev

Rev 1564 | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

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