From c6b3f75882715db64dffb54f0a139bae36fa20ca Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Wed, 12 Jun 2013 21:45:50 +1200 Subject: Finish GlobalSat decoder --- .../traccar/protocol/GlobalSatProtocolDecoder.java | 205 +++++++++++---------- 1 file changed, 106 insertions(+), 99 deletions(-) (limited to 'src') diff --git a/src/org/traccar/protocol/GlobalSatProtocolDecoder.java b/src/org/traccar/protocol/GlobalSatProtocolDecoder.java index a2b115445..ee94158be 100644 --- a/src/org/traccar/protocol/GlobalSatProtocolDecoder.java +++ b/src/org/traccar/protocol/GlobalSatProtocolDecoder.java @@ -28,6 +28,7 @@ import org.traccar.ServerManager; import org.traccar.helper.AdvancedConnection; import org.traccar.helper.Log; import org.traccar.helper.NamedParameterStatement; +import org.traccar.model.ExtendedInfoFormatter; import org.traccar.model.Position; public class GlobalSatProtocolDecoder extends BaseProtocolDecoder { @@ -52,30 +53,17 @@ public class GlobalSatProtocolDecoder extends BaseProtocolDecoder { } } - /** - * Regular expressions pattern - */ - /*static private Pattern pattern = Pattern.compile( - "\\$GPRMC," + - "(\\d{2})(\\d{2})(\\d{2})\\.(\\d+)," + // Time (HHMMSS.SSS) - "([AV])," + // Validity - "(\\d{2})(\\d{2}\\.\\d+)," + // Latitude (DDMM.MMMM) - "([NS])," + - "(\\d{3})(\\d{2}\\.\\d+)," + // Longitude (DDDMM.MMMM) - "([EW])," + - "(\\d+\\.?\\d*)?," + // Speed - "(\\d+\\.?\\d*)?," + // Course - "(\\d{2})(\\d{2})(\\d{2})" + // Date (DDMMYY) - ".+"); // Other (Checksumm)*/ - - // TODO: Acknowledgement - @Override protected Object decode( ChannelHandlerContext ctx, Channel channel, Object msg) throws Exception { String sentence = (String) msg; + + // Send acknowledgement + if (channel != null) { + channel.write("ACK\r"); + } // Message type String format; @@ -87,92 +75,111 @@ public class GlobalSatProtocolDecoder extends BaseProtocolDecoder { return null; } - // TODO: check that message contains required parameters - - - - // Detect device ID - /*if (sentence.contains("$PGID")) { - String imei = sentence.substring(6, sentence.length() - 3); - try { - deviceId = getDataManager().getDeviceByImei(imei).getId(); - } catch(Exception error) { - Log.warning("Unknown device - " + imei); - } + // Check that message contains required parameters + if (!format.contains("B") || !format.contains("S") || + !(format.contains("1") || format.contains("2") || format.contains("3")) || + !(format.contains("6") || format.contains("7") || format.contains("8"))) { + return null; } - // Parse message - else if (sentence.contains("$GPRMC") && deviceId != null) { - - // Send response - if (channel != null) { - channel.write("OK1\r\n"); - } - - // Parse message - Matcher parser = pattern.matcher(sentence); - if (!parser.matches()) { - return null; - } - - // Create new position - Position position = new Position(); - position.setDeviceId(deviceId); - - Integer index = 1; - - // Time - Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC")); - time.clear(); - time.set(Calendar.HOUR, Integer.valueOf(parser.group(index++))); - time.set(Calendar.MINUTE, Integer.valueOf(parser.group(index++))); - time.set(Calendar.SECOND, Integer.valueOf(parser.group(index++))); - index += 1; // Skip milliseconds - - // Validity - position.setValid(parser.group(index++).compareTo("A") == 0 ? true : false); - - // Latitude - Double latitude = Double.valueOf(parser.group(index++)); - latitude += Double.valueOf(parser.group(index++)) / 60; - if (parser.group(index++).compareTo("S") == 0) latitude = -latitude; - position.setLatitude(latitude); - - // Longitude - Double lonlitude = Double.valueOf(parser.group(index++)); - lonlitude += Double.valueOf(parser.group(index++)) / 60; - if (parser.group(index++).compareTo("W") == 0) lonlitude = -lonlitude; - position.setLongitude(lonlitude); - - // Speed - String speed = parser.group(index++); - if (speed != null) { - position.setSpeed(Double.valueOf(speed)); - } else { - position.setSpeed(0.0); - } - - // Course - String course = parser.group(index++); - if (course != null) { - position.setCourse(Double.valueOf(course)); - } else { - position.setCourse(0.0); + // Tokenise + if (format.contains("*")) { + format = format.substring(0, format.indexOf('*')); + sentence = sentence.substring(0, sentence.indexOf('*')); + } + String[] values = sentence.split(","); + + // Parse data + Position position = new Position(); + ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter("globalsat"); + + for (int formatIndex = 0, valueIndex = 1; formatIndex < format.length() && valueIndex < values.length; formatIndex++) { + String value = values[valueIndex]; + + switch(format.charAt(formatIndex)) { + case 'S': + try { + position.setDeviceId(getDataManager().getDeviceByImei(value).getId()); + } catch(Exception error) { + Log.warning("Unknown device - " + value); + return null; + } + break; + case 'A': + if (value.isEmpty()) { + position.setValid(false); + } else { + position.setValid(Integer.valueOf(value) != 1); + } + break; + case 'B': + Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC")); + time.clear(); + time.set(Calendar.DAY_OF_MONTH, Integer.valueOf(value.substring(0, 2))); + time.set(Calendar.MONTH, Integer.valueOf(value.substring(2, 4)) - 1); + time.set(Calendar.YEAR, 2000 + Integer.valueOf(value.substring(4))); + value = values[++valueIndex]; + time.set(Calendar.HOUR, Integer.valueOf(value.substring(0, 2))); + time.set(Calendar.MINUTE, Integer.valueOf(value.substring(2, 4))); + time.set(Calendar.SECOND, Integer.valueOf(value.substring(4))); + position.setTime(time.getTime()); + break; + case 'C': + valueIndex += 1; + break; + case '1': + double longitude = Double.valueOf(value.substring(1)); + if (value.charAt(0) == 'E') longitude = -longitude; + position.setLongitude(longitude); + break; + case '2': + longitude = Double.valueOf(value.substring(4)) / 60; + longitude += Integer.valueOf(value.substring(1, 4)); + if (value.charAt(0) == 'E') longitude = -longitude; + position.setLongitude(longitude); + break; + case '3': + position.setLongitude(Double.valueOf(value) * 0.000001); + break; + case '6': + double latitude = Double.valueOf(value.substring(1)); + if (value.charAt(0) == 'S') latitude = -latitude; + position.setLatitude(latitude); + break; + case '7': + latitude = Double.valueOf(value.substring(3)) / 60; + latitude += Integer.valueOf(value.substring(1, 3)); + if (value.charAt(0) == 'S') latitude = -latitude; + position.setLatitude(latitude); + break; + case '8': + position.setLatitude(Double.valueOf(value) * 0.000001); + break; + case 'G': + position.setAltitude(Double.valueOf(value)); + break; + case 'H': + position.setSpeed(Double.valueOf(value)); + break; + case 'I': + position.setSpeed(Double.valueOf(value) * 0.539957); + break; + case 'J': + position.setSpeed(Double.valueOf(value) * 0.868976); + break; + case 'K': + position.setCourse(Double.valueOf(value)); + break; + default: + // Unsupported + break; } - // Date - time.set(Calendar.DAY_OF_MONTH, Integer.valueOf(parser.group(index++))); - time.set(Calendar.MONTH, Integer.valueOf(parser.group(index++)) - 1); - time.set(Calendar.YEAR, 2000 + Integer.valueOf(parser.group(index++))); - position.setTime(time.getTime()); - - // Altitude - position.setAltitude(0.0); - - return position; - }*/ + valueIndex += 1; + } - return null; + position.setExtendedInfo(extendedInfo.toString()); + return position; } } -- cgit v1.2.3