Subversion Repositories Projects

package dongfang.mkt.main;

import java.io.FileInputStream;

import java.io.FileWriter;

import java.io.IOException;

import java.io.InputStream;

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;

import dongfang.mkt.comm.FrameQueue;

import dongfang.mkt.comm.MKConnection;

import dongfang.mkt.comm.serial.RXTXSerialPort;

import dongfang.mkt.configuration.ParameterSet;

import dongfang.mkt.frames.ReadParamSetRequestFrame;

import dongfang.mkt.frames.ReadParamSetResponseFrame;

import dongfang.mkt.frames.WriteParamSetRequestFrame;

import dongfang.mkt.frames.WriteParamSetResponseFrame;

public class ParameterSetConfigurator {

        private static void configure(String portIdentifier, WriteParamSetRequestFrame frame,

                        int parameterSetNumber) throws IOException {

                MKConnection port = new RXTXSerialPort();

                port.init(portIdentifier);

                FrameQueue q = new FrameQueue(port);

                frame.setConfigurationSetNumber(parameterSetNumber);

                q.sendRequest(frame);

                WriteParamSetResponseFrame r = (WriteParamSetResponseFrame) q.getResponseFor(frame, 5000);

                if (r == null) {

                        System.err.println("ERROR. Timeout waiting for response.");

                } else if (!r.wasAccepted()) {

                        System.err

                                        .println("ERROR. Parameter set not accepted. Check version against MK firmware EEPROM configuration version and checkparameter set number");

                } else {

                        System.out.println("Saved parameter set #"

                                        + r.getParameterSetNumber() + ".");

                }

                q.kill();

        }

        private static void writeConfiguration(String portIdentifier, String s_parameterSetNumber,

                        String fileName) throws IOException {

                System.out.println("Writing parameter set #" + s_parameterSetNumber + " from file: " + fileName);

                int parameterSetNumber = Integer.parseInt(s_parameterSetNumber);

                InputStream inputStream = new FileInputStream(fileName);

                WriteParamSetRequestFrame frame = parseXMLParameterSet(inputStream);

                configure(portIdentifier, frame, parameterSetNumber);

        }

        private static ParameterSet readConfiguration(String portIdentifier, String s_parameterSetNumber) throws IOException {

                MKConnection port =  new RXTXSerialPort();

                port.init(portIdentifier);

                FrameQueue q = new FrameQueue(port);

                ParameterSet cs = null;

                int parameterSetNumber = Integer.parseInt(s_parameterSetNumber);

                ReadParamSetRequestFrame frame = new ReadParamSetRequestFrame();

                frame.setConfigurationSetNumber(parameterSetNumber);

                q.sendRequest(frame);

                ReadParamSetResponseFrame r = (ReadParamSetResponseFrame) q.getResponseFor(frame, 5000);

                if (r == null) {

                        System.err.println("ERROR. Timeout waiting for response.");

                } else {

                        int paramSetVersion = r.getConfigurationVersion();

                        int[] data = r.getData();

                        cs = ParameterSet.parseXMLParameterSet(paramSetVersion);

                        cs.setData(data);

                        System.out.println(cs.toXML());

                }

                q.kill();

                return cs;

        }

        /*

        private static ConfigSet simpleReadConfiguration(int parameterSetNumber)

                        throws IOException {

                MKCommPort port = new RXTXSerialPort();

                port.init(null);

                FrameQueue q = new FrameQueue(port);

                ConfigSet cs = null;

                UniversalReadParamSetRequestFrame frame = new UniversalReadParamSetRequestFrame();

                frame.setConfigurationSetNumber(parameterSetNumber);

                q.sendRequest(frame);

                UniversalReadParamSetResponseFrame r = (UniversalReadParamSetResponseFrame) q

                                .getResponseFor(frame, 3000);

                if (r == null) {

                        System.err.println("ERROR. Timeout waiting for response.");

                } else {

                        int paramSetVersion = r.getConfigurationVersion();

                        int[] data = r.getData();

                        for (int i=0; i<data.length; i++)

                                System.out.println(data[i]);

                }

                q.kill();

                return cs;

        }

        */

        private static void readConfiguration(String portIdentifier, String s_parameterSetNumber, String fileName) throws IOException {

                ParameterSet cs = readConfiguration(portIdentifier, s_parameterSetNumber);

                if (cs != null) {

                        FileWriter fw = new FileWriter(fileName);

                        fw.write(cs.toXML());

                        fw.close();

                }

        }

        private static int substituteVariables(String s_value) {

                int numberOfHighestVar = 255;

                int numberOfLowestVar = numberOfHighestVar - ParameterSet.NUMBER_OF_VARIABLES + 1;

                for (int i = 0; i < ParameterSet.NUMBER_OF_VARIABLES; i++) {

                        String varName = "var" + i;

                        if (varName.equals(s_value)) {

                                System.out.println("Substing: " + s_value + "-->" + (numberOfLowestVar + i));

                                return numberOfLowestVar + i;

                        }

                }

                return -1;

        }

        private static WriteParamSetRequestFrame parseXMLParameterSet(

                        InputStream input) throws IOException {

                DocumentBuilderFactory saxfac = DocumentBuilderFactory.newInstance();

                saxfac.setValidating(false);

                try {

                        DocumentBuilder bldr = saxfac.newDocumentBuilder();

                        Document doc = bldr.parse(input);

                        XPath xpath = XPathFactory.newInstance().newXPath();

                        String s_eepromVersion = xpath.evaluate(

                                        "/parameterset/@eepromVersion", doc);

                        String ss_length = xpath.evaluate("/parameterset/@length", doc);

                        int s_length = 0;

                        try {

                                s_length = Integer.parseInt(ss_length);

                        } catch (NumberFormatException ex) {

                                // ignore.

                        }

                        int eepromVersion = -1;

                        try {

                                eepromVersion = Integer.parseInt(s_eepromVersion);

                        } catch (NumberFormatException ex) {

                                System.err

                                                .println("The parameterset element must have an 'eepromVersion' attribute with a numerical value (eg.<parameterset eepromVersion='74'>)");

                                System.exit(-1);

                        }

                        // if (s_length != null)

                        // try {

                        // length = Integer.parseInt(s_length);

                        // } catch (NumberFormatException ex) {

                        // System.err.println("The length attribute of the parameterset must have a numerical value");

                        // System.exit(-1);

                        // }

                        NodeList parameterNodes = (NodeList) xpath.evaluate(

                                        "/parameterset/parameter", doc, XPathConstants.NODESET);

                        int[] parameters = new int[parameterNodes.getLength()];

                        NodeList allChildNodes = (NodeList) xpath.evaluate(

                                        "/parameterset/*", doc, XPathConstants.NODESET);

                        if (parameterNodes.getLength() != allChildNodes.getLength()) {

                                System.err.println("There seems to be a child element of parameterset whose name is not \"parameter\".");

                        // System.exit(-1);

                        }

                        if (s_length >=0 && s_length != parameterNodes.getLength()) {

                        System.err.println("The number of parameters ("+parameterNodes.getLength()+") does not match the number in the length attribute of the parameterset element ("+s_length+").");

                        // System.exit(-1);

                        }

                        for (int i = 0; i < parameterNodes.getLength(); i++) {

                                Element e = (Element) parameterNodes.item(i);

                                int value = 0;

                                if (e.hasAttribute("value")) {

                                        String s_value = e.getAttribute("value");

                                        value = substituteVariables(s_value);

                                        if (value < 0)

                                                try {

                                                        value = Integer.parseInt(s_value);

                                                } catch (NumberFormatException ex) {

                                                        throw new NumberFormatException(

                                                                        "Value is not a number and not a variable name.");

                                                }

                                } else {

                                        NodeList bitNodes = (NodeList) xpath.evaluate("bit", e,

                                                        XPathConstants.NODESET);

                                        for (int j = 0; j < 8; j++) {

                                                Element bitElement = (Element) bitNodes.item(j);

                                                if (bitElement != null) {

                                                        String s_bitValue = bitElement

                                                                        .getAttribute("value");

                                                        if ("1".equals(s_bitValue))

                                                                value |= (1 << j);

                                                        else if (!"0".equals(s_bitValue))

                                                                throw new NumberFormatException(

                                                                                "Bit value was not 0 or 1.");

                                                }

                                        }

                                }

                                parameters[i] = value;

                        }

                        input.close();

                        return new WriteParamSetRequestFrame(eepromVersion, "01234567890ab".toCharArray(), parameters);

                } catch (ParserConfigurationException ex) {

                        // Should never happen.

                        throw new RuntimeException(ex);

                } catch (SAXException ex) {

                        System.err.println(ex);

                        System.err

                                        .println("There is something screwed with your XML document. It is not well-formed and won't parse.");

                        throw new RuntimeException("Parse error.");

                } catch (XPathExpressionException ex) {

                        // Should never happen.

                        throw new RuntimeException(ex);

                }

        }

        static void help() {

                System.err

                .println("Usage: ParameterSetConfigurator r [parameter set number to read from] [filename to write to]");

System.err

                .println("Usage: ParameterSetConfigurator w [parameter set number to write to] [filename to read from]");

System.exit(-1);

        }

        public static void main(String[] args) throws IOException {

                if (!"r".equals(args[0]) && !"w".equals(args[0])) help();

                if ("w".equals(args[0]) && (args.length!=3 && args.length!=4)) help();

                if ("r".equals(args[0]) && (args.length!=3 && args.length!=4)) help();

                String portIdentifier = null;

                if ("r".equals(args[0])) {

                        readConfiguration(portIdentifier, args[1]);

                } else {

                        writeConfiguration(portIdentifier, args[1], args[2]);

                }

                System.exit(0);

        }

}