From c9eb46368a3e8de594ea53770cd5853b5d025966 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Fri, 24 Apr 2015 15:58:59 +1200 Subject: Add AVL301 protocol support --- default.cfg | 4 + src/org/traccar/ServerManager.java | 13 ++ .../traccar/protocol/Avl301ProtocolDecoder.java | 147 +++++++++++++++++++++ .../protocol/Avl301ProtocolDecoderTest.java | 28 ++++ 4 files changed, 192 insertions(+) create mode 100644 src/org/traccar/protocol/Avl301ProtocolDecoder.java create mode 100644 test/org/traccar/protocol/Avl301ProtocolDecoderTest.java diff --git a/default.cfg b/default.cfg index 50fe2259f..a97e4ec78 100644 --- a/default.cfg +++ b/default.cfg @@ -411,4 +411,8 @@ true 5084 + + true + 5085 + diff --git a/src/org/traccar/ServerManager.java b/src/org/traccar/ServerManager.java index 4c9645e41..5e549b177 100644 --- a/src/org/traccar/ServerManager.java +++ b/src/org/traccar/ServerManager.java @@ -124,6 +124,7 @@ public class ServerManager { initCalAmpServer("calamp"); initMtxServer("mtx"); initTytanServer("tytan"); + initAvl301Server("avl301"); initProtocolDetector(); } @@ -1303,4 +1304,16 @@ public class ServerManager { } } + private void initAvl301Server(final String protocol) throws SQLException { + if (isProtocolEnabled(protocol)) { + serverList.add(new TrackerServer(new ServerBootstrap(), protocol) { + @Override + protected void addSpecificHandlers(ChannelPipeline pipeline) { + pipeline.addLast("frameDecoder", new LengthFieldBasedFrameDecoder(256, 2, 1, 2, 0)); + pipeline.addLast("objectDecoder", new Avl301ProtocolDecoder(protocol)); + } + }); + } + } + } diff --git a/src/org/traccar/protocol/Avl301ProtocolDecoder.java b/src/org/traccar/protocol/Avl301ProtocolDecoder.java new file mode 100644 index 000000000..4bc7686e7 --- /dev/null +++ b/src/org/traccar/protocol/Avl301ProtocolDecoder.java @@ -0,0 +1,147 @@ +/* + * Copyright 2015 Anton Tananaev (anton.tananaev@gmail.com) + * + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ +package org.traccar.protocol; + +import org.jboss.netty.buffer.ChannelBuffer; +import org.jboss.netty.buffer.ChannelBuffers; +import org.jboss.netty.channel.Channel; +import org.jboss.netty.channel.ChannelHandlerContext; +import org.traccar.BaseProtocolDecoder; +import org.traccar.model.ExtendedInfoFormatter; +import org.traccar.model.Position; + +import java.util.Calendar; +import java.util.TimeZone; + +public class Avl301ProtocolDecoder extends BaseProtocolDecoder { + + public Avl301ProtocolDecoder(String protocol) { + super(protocol); + } + + private String readImei(ChannelBuffer buf) { + int b = buf.readUnsignedByte(); + StringBuilder imei = new StringBuilder(); + imei.append(b & 0x0F); + for (int i = 0; i < 7; i++) { + b = buf.readUnsignedByte(); + imei.append((b & 0xF0) >> 4); + imei.append(b & 0x0F); + } + return imei.toString(); + } + + private static final int MSG_LOGIN = 'L'; + private static final int MSG_STATUS = 'H'; + private static final int MSG_GPS_LBS_STATUS = '$'; + + private static void sendResponse(Channel channel, int type) { + if (channel != null) { + ChannelBuffer response = ChannelBuffers.directBuffer(5); + response.writeByte('$'); + response.writeByte(type); + response.writeByte('#'); + response.writeByte('\r'); response.writeByte('\n'); + channel.write(response); + } + } + + @Override + protected Object decode( + ChannelHandlerContext ctx, Channel channel, Object msg) + throws Exception { + + ChannelBuffer buf = (ChannelBuffer) msg; + + buf.skipBytes(1); // header + int type = buf.readUnsignedByte(); + buf.readUnsignedByte(); // length + + if (type == MSG_LOGIN) { + + if (identify(readImei(buf))) { + sendResponse(channel, type); + } + + } else if (hasDeviceId() && type == MSG_STATUS) { + + sendResponse(channel, type); + + } else if (hasDeviceId() && type == MSG_GPS_LBS_STATUS) { + + // Create new position + Position position = new Position(); + position.setDeviceId(getDeviceId()); + ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter(getProtocol()); + + // Date and time(6) + Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC")); + time.clear(); + time.set(Calendar.YEAR, 2000 + buf.readUnsignedByte()); + time.set(Calendar.MONTH, buf.readUnsignedByte() - 1); + time.set(Calendar.DAY_OF_MONTH, buf.readUnsignedByte()); + time.set(Calendar.HOUR_OF_DAY, buf.readUnsignedByte()); + time.set(Calendar.MINUTE, buf.readUnsignedByte()); + time.set(Calendar.SECOND, buf.readUnsignedByte()); + position.setTime(time.getTime()); + + // GPS length and Satellites count + int gpsLength = buf.readUnsignedByte(); + extendedInfo.set("satellites", gpsLength & 0xf); + gpsLength >>= 4; + + //Skip Satellite numbers + buf.skipBytes(1); + + // Location + double latitude = buf.readUnsignedInt() / 600000.0; + double longitude = buf.readUnsignedInt() / 600000.0; + position.setSpeed(buf.readUnsignedByte() * 1.0); // kph? + + // Course and flags + int union = buf.readUnsignedShort(); + position.setCourse((double) (union & 0x03FF)); + position.setValid((union & 0x1000) != 0); + if ((union & 0x0400) != 0) latitude = -latitude; + if ((union & 0x0800) != 0) longitude = -longitude; + + position.setLatitude(latitude); + position.setLongitude(longitude); + position.setAltitude(0.0); + + if ((union & 0x4000) != 0) { + extendedInfo.set("acc", (union & 0x8000) != 0); + } + + extendedInfo.set("lac", buf.readUnsignedShort()); + extendedInfo.set("cell", buf.readUnsignedMedium()); + extendedInfo.set("alarm", true); + int flags = buf.readUnsignedByte(); + extendedInfo.set("acc", (flags & 0x2) != 0); + + // TODO parse other flags + + extendedInfo.set("power", buf.readUnsignedByte()); + extendedInfo.set("gsm", buf.readUnsignedByte()); + + position.setExtendedInfo(extendedInfo.toString()); + return position; + } + + return null; + } + +} diff --git a/test/org/traccar/protocol/Avl301ProtocolDecoderTest.java b/test/org/traccar/protocol/Avl301ProtocolDecoderTest.java new file mode 100644 index 000000000..666bb0b43 --- /dev/null +++ b/test/org/traccar/protocol/Avl301ProtocolDecoderTest.java @@ -0,0 +1,28 @@ +package org.traccar.protocol; + +import org.jboss.netty.buffer.ChannelBuffers; +import org.junit.Test; +import org.traccar.helper.ChannelBufferTools; + +import static org.junit.Assert.assertNull; +import static org.traccar.helper.DecoderVerifier.verify; + +public class Avl301ProtocolDecoderTest extends ProtocolDecoderTest { + + @Test + public void testDecode() throws Exception { + + Avl301ProtocolDecoder decoder = new Avl301ProtocolDecoder(null); + + assertNull(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertHexString( + "244c0f086058500087335500010d0a")))); + + assertNull(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertHexString( + "24480d1001c3065c0d00010d0a")))); + + verify(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertHexString( + "24242c0f041710001d0e060146944904ff4ac40000148f0651044b001a081001be06590daa00000108a30d0a")))); + + } + +} -- cgit v1.2.3