From 1cde955eb9e506ec3a4cf4b3829d88b798d45175 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Sun, 16 Dec 2012 19:00:49 +1300 Subject: Added skypatrol protocol (fix #82) --- .../traccar/protocol/SkypatrolProtocolDecoder.java | 247 ++++++++++++++------- 1 file changed, 168 insertions(+), 79 deletions(-) (limited to 'src/org') diff --git a/src/org/traccar/protocol/SkypatrolProtocolDecoder.java b/src/org/traccar/protocol/SkypatrolProtocolDecoder.java index d5adf2aaf..3f54fd0bf 100644 --- a/src/org/traccar/protocol/SkypatrolProtocolDecoder.java +++ b/src/org/traccar/protocol/SkypatrolProtocolDecoder.java @@ -15,10 +15,10 @@ */ package org.traccar.protocol; +import java.nio.charset.Charset; import java.util.Calendar; import java.util.TimeZone; -import java.util.regex.Matcher; -import java.util.regex.Pattern; +import org.jboss.netty.buffer.ChannelBuffer; import org.jboss.netty.channel.Channel; import org.jboss.netty.channel.ChannelHandlerContext; import org.traccar.GenericProtocolDecoder; @@ -31,11 +31,6 @@ import org.traccar.model.Position; */ public class SkypatrolProtocolDecoder extends GenericProtocolDecoder { - /** - * Device ID - */ - private Long deviceId; - /** * Initialize */ @@ -43,108 +38,202 @@ public class SkypatrolProtocolDecoder extends GenericProtocolDecoder { super(dataManager); } - /** - * 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{2})?," + // Speed - "(\\d+\\.\\d{2})?," + // Course - "(\\d{2})(\\d{2})(\\d{2})" + // Date (DDMMYY) - ".+"); // Other (Checksumm) - + private static boolean checkBit(long mask, int bit) { + long checkMask = 1 << bit; + return (mask & checkMask) == checkMask; + } + + private static double convertCoordinate(long coordinate) { + int sign = 1; + if (coordinate > 0x7fffffffl) { + sign = -1; + coordinate = 0xffffffffl - coordinate; + } + + double degrees = coordinate / 1000000; + degrees += (coordinate % 1000000) / 600000.0; + + return sign * degrees; + } + /** * Decode message */ + @Override protected Object decode( ChannelHandlerContext ctx, Channel channel, Object msg) throws Exception { - String sentence = (String) msg; + ChannelBuffer buf = (ChannelBuffer) msg; - // Detect device ID - if (sentence.contains("$PGID")) { - String imei = sentence.substring(6, 6 + 15); - try { - deviceId = getDataManager().getDeviceByImei(imei).getId(); - } catch(Exception error) { - Log.warning("Unknown device - " + imei); - } + // Read header + int apiNumber = buf.readUnsignedShort(); + int commandType = buf.readUnsignedByte(); + int messageType = buf.getUnsignedByte(buf.readerIndex()) >> 4; + boolean needAck = (buf.readUnsignedByte() & 0xf) == 1; + long mask = 0; + if (buf.readUnsignedByte() == 4) { + mask = buf.readUnsignedInt(); } - // Parse message - else if (sentence.contains("$GPRMC") && deviceId != null) { - - // Send response - if (channel != null) { - channel.write("OK1\r\n"); + // Binary position report + if (apiNumber == 5 && + commandType == 2 && + messageType == 1 && + checkBit(mask, 0)) { + + // Create new position + Position position = new Position(); + StringBuilder extendedInfo = new StringBuilder("skypatrol"); + + // Status code + if (checkBit(mask, 1)) { + extendedInfo.append(""); + extendedInfo.append(buf.readUnsignedInt()); + extendedInfo.append(""); } - - // Parse message - Matcher parser = pattern.matcher(sentence); - if (!parser.matches()) { + + // Device id + String id = null; + if (checkBit(mask, 23)) { + id = buf.toString(buf.readerIndex(), 8, Charset.defaultCharset()).trim(); + buf.skipBytes(8); + } else if (checkBit(mask, 2)) { + id = buf.toString(buf.readerIndex(), 22, Charset.defaultCharset()).trim(); + buf.skipBytes(22); + } else { + Log.warning("No device id field"); return null; } + try { + position.setDeviceId(getDataManager().getDeviceByImei(id).getId()); + } catch(Exception error) { + Log.warning("Unknown device - " + id); + return null; + } + + // IO data + if (checkBit(mask, 3)) { + buf.readUnsignedShort(); + } + + // ADC 1 + if (checkBit(mask, 4)) { + buf.readUnsignedShort(); + } - // Create new position - Position position = new Position(); - position.setDeviceId(deviceId); - - Integer index = 1; + // ADC 2 + if (checkBit(mask, 5)) { + buf.readUnsignedShort(); + } - // Time + // Function category + if (checkBit(mask, 7)) { + buf.readUnsignedByte(); + } + 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); + // Date + if (checkBit(mask, 8)) { + time.set(Calendar.DAY_OF_MONTH, buf.readUnsignedByte()); + time.set(Calendar.MONTH, buf.readUnsignedByte() - 1); + time.set(Calendar.YEAR, 2000 + buf.readUnsignedByte()); + } + + // GPS status + if (checkBit(mask, 9)) { + position.setValid(buf.readUnsignedByte() == 1); + } // 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); + if (checkBit(mask, 10)) { + position.setLatitude(convertCoordinate(buf.readUnsignedInt())); + } // 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); - + if (checkBit(mask, 11)) { + position.setLongitude(convertCoordinate(buf.readUnsignedInt())); + } + // Speed - String speed = parser.group(index++); - if (speed != null) { - position.setSpeed(Double.valueOf(speed)); - } else { - position.setSpeed(0.0); + if (checkBit(mask, 12)) { + position.setSpeed(buf.readUnsignedShort() / 10.0); } // Course - String course = parser.group(index++); - if (course != null) { - position.setCourse(Double.valueOf(course)); - } else { - position.setCourse(0.0); + if (checkBit(mask, 13)) { + position.setCourse(buf.readUnsignedShort() / 10.0); } - // 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++))); + // Time + if (checkBit(mask, 14)) { + time.set(Calendar.HOUR, buf.readUnsignedByte()); + time.set(Calendar.MINUTE, buf.readUnsignedByte()); + time.set(Calendar.SECOND, buf.readUnsignedByte()); + } + position.setTime(time.getTime()); - + // Altitude - position.setAltitude(0.0); + if (checkBit(mask, 15)) { + buf.skipBytes(3); + } + + // Satellites + if (checkBit(mask, 16)) { + extendedInfo.append(""); + extendedInfo.append(buf.readUnsignedByte()); + extendedInfo.append(""); + } + + // Battery percentage + if (checkBit(mask, 17)) { + buf.readUnsignedShort(); + } + + // Trip milage + if (checkBit(mask, 20)) { + extendedInfo.append(""); + extendedInfo.append(buf.readUnsignedInt()); + extendedInfo.append(""); + } + + // Milage + if (checkBit(mask, 21)) { + extendedInfo.append(""); + extendedInfo.append(buf.readUnsignedInt()); + extendedInfo.append(""); + } + + // Time of message generation + if (checkBit(mask, 22)) { + buf.skipBytes(6); + } + + // Battery level + if (checkBit(mask, 24)) { + position.setPower(buf.readUnsignedShort() / 1000.0); + } + + // GPS overspeed + if (checkBit(mask, 25)) { + buf.skipBytes(18); + } + + // Cell information + if (checkBit(mask, 26)) { + buf.skipBytes(54); + } + + // Sequence number + if (checkBit(mask, 28)) { + position.setId((long) buf.readUnsignedShort()); + } + + // Extended info + position.setExtendedInfo(extendedInfo.toString()); return position; } -- cgit v1.2.3