From d46ca1ac0b96472eb52604761bd1b49330d18323 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Sat, 20 Jul 2013 17:48:24 +1200 Subject: Support Teltonika GH3000 protocol --- .../traccar/protocol/TeltonikaProtocolDecoder.java | 129 ++++++++++++++++----- 1 file changed, 101 insertions(+), 28 deletions(-) (limited to 'src/org/traccar/protocol/TeltonikaProtocolDecoder.java') diff --git a/src/org/traccar/protocol/TeltonikaProtocolDecoder.java b/src/org/traccar/protocol/TeltonikaProtocolDecoder.java index 7561e35e1..2cc7d1477 100644 --- a/src/org/traccar/protocol/TeltonikaProtocolDecoder.java +++ b/src/org/traccar/protocol/TeltonikaProtocolDecoder.java @@ -55,13 +55,21 @@ public class TeltonikaProtocolDecoder extends BaseProtocolDecoder { channel.write(response); } } + + private static boolean checkBit(long mask, int bit) { + long checkMask = 1 << bit; + return (mask & checkMask) == checkMask; + } + + private static final int CODEC_GH3000 = 0x07; + private static final int CODEC_FM4X00 = 0x08; private List parseLocation(Channel channel, ChannelBuffer buf) { List positions = new LinkedList(); buf.skipBytes(4); // marker buf.readUnsignedInt(); // data length - buf.readUnsignedByte(); // codec + int codec = buf.readUnsignedByte(); // codec int count = buf.readUnsignedByte(); for (int i = 0; i < count; i++) { @@ -69,48 +77,113 @@ public class TeltonikaProtocolDecoder extends BaseProtocolDecoder { ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter("teltonika"); position.setDeviceId(deviceId); - position.setTime(new Date(buf.readLong())); + + int globalMask = 0x0f; + + if (codec == CODEC_GH3000) { - extendedInfo.set("priority", buf.readUnsignedByte()); + long time = buf.readUnsignedInt() & 0x3fffffff; + time += 1199145600; // 2008-01-01 00:00:00 + position.setTime(new Date(time * 1000)); + + globalMask = buf.readUnsignedByte(); + if (!checkBit(globalMask, 0)) { + return null; + } + + int locationMask = buf.readUnsignedByte(); + + if (checkBit(locationMask, 0)) { + position.setLatitude(Double.valueOf(buf.readFloat())); + position.setLongitude(Double.valueOf(buf.readFloat())); + } + + if (checkBit(locationMask, 1)) { + position.setAltitude((double) buf.readUnsignedShort()); + } + + if (checkBit(locationMask, 2)) { + position.setCourse(buf.readUnsignedByte() * 360.0 / 256); + } + + if (checkBit(locationMask, 3)) { + position.setSpeed((double) buf.readUnsignedByte()); + } + + if (checkBit(locationMask, 4)) { + int satellites = buf.readUnsignedByte(); + extendedInfo.set("satellites", satellites); + position.setValid(satellites >= 3); + } + + if (checkBit(locationMask, 5)) { + extendedInfo.set("area", buf.readUnsignedShort()); + extendedInfo.set("cell", buf.readUnsignedShort()); + } + + if (checkBit(locationMask, 6)) { + extendedInfo.set("gsm", buf.readUnsignedByte()); + } + + if (checkBit(locationMask, 7)) { + extendedInfo.set("operator", buf.readUnsignedInt()); + } - position.setLongitude(buf.readInt() / 10000000.0); - position.setLatitude(buf.readInt() / 10000000.0); - position.setAltitude((double) buf.readUnsignedShort()); - position.setCourse((double) buf.readUnsignedShort()); - - int satellites = buf.readUnsignedByte(); - extendedInfo.set("satellites", satellites); + } else { - position.setValid(satellites != 0); - - position.setSpeed(buf.readUnsignedShort() * 0.539957); + position.setTime(new Date(buf.readLong())); - extendedInfo.set("event", buf.readUnsignedByte()); - - buf.readUnsignedByte(); // total IO data records + extendedInfo.set("priority", buf.readUnsignedByte()); + + position.setLongitude(buf.readInt() / 10000000.0); + position.setLatitude(buf.readInt() / 10000000.0); + position.setAltitude((double) buf.readUnsignedShort()); + position.setCourse((double) buf.readUnsignedShort()); + int satellites = buf.readUnsignedByte(); + extendedInfo.set("satellites", satellites); + + position.setValid(satellites != 0); + + position.setSpeed(buf.readUnsignedShort() * 0.539957); + + extendedInfo.set("event", buf.readUnsignedByte()); + + buf.readUnsignedByte(); // total IO data records + + } + // Read 1 byte data - int cnt = buf.readUnsignedByte(); - for (int j = 0; j < cnt; j++) { - extendedInfo.set("io" + buf.readUnsignedByte(), buf.readUnsignedByte()); + if (checkBit(globalMask, 1)) { + int cnt = buf.readUnsignedByte(); + for (int j = 0; j < cnt; j++) { + extendedInfo.set("io" + buf.readUnsignedByte(), buf.readUnsignedByte()); + } } + // Read 2 byte data - cnt = buf.readUnsignedByte(); - for (int j = 0; j < cnt; j++) { - extendedInfo.set("io" + buf.readUnsignedByte(), buf.readUnsignedShort()); + if (checkBit(globalMask, 2)) { + int cnt = buf.readUnsignedByte(); + for (int j = 0; j < cnt; j++) { + extendedInfo.set("io" + buf.readUnsignedByte(), buf.readUnsignedShort()); + } } // Read 4 byte data - cnt = buf.readUnsignedByte(); - for (int j = 0; j < cnt; j++) { - extendedInfo.set("io" + buf.readUnsignedByte(), buf.readUnsignedInt()); + if (checkBit(globalMask, 3)) { + int cnt = buf.readUnsignedByte(); + for (int j = 0; j < cnt; j++) { + extendedInfo.set("io" + buf.readUnsignedByte(), buf.readUnsignedInt()); + } } // Read 8 byte data - cnt = buf.readUnsignedByte(); - for (int j = 0; j < cnt; j++) { - extendedInfo.set("io" + buf.readUnsignedByte(), buf.readLong()); + if (codec == CODEC_FM4X00) { + int cnt = buf.readUnsignedByte(); + for (int j = 0; j < cnt; j++) { + extendedInfo.set("io" + buf.readUnsignedByte(), buf.readLong()); + } } position.setExtendedInfo(extendedInfo.toString()); -- cgit v1.2.3