From f9210e4709188f7c344fe0dd94fe58b4a89307f8 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Sat, 17 Aug 2013 22:35:30 +1200 Subject: Add Gator/Seeworld protocol (fix #217) --- default.cfg | 4 + src/org/traccar/ServerManager.java | 12 ++ src/org/traccar/protocol/GatorProtocolDecoder.java | 141 +++++++++++++++++++++ .../traccar/protocol/GatorProtocolDecoderTest.java | 21 +++ 4 files changed, 178 insertions(+) create mode 100644 src/org/traccar/protocol/GatorProtocolDecoder.java create mode 100644 test/org/traccar/protocol/GatorProtocolDecoderTest.java diff --git a/default.cfg b/default.cfg index 93cb90ea6..446e861a5 100644 --- a/default.cfg +++ b/default.cfg @@ -270,4 +270,8 @@ true 5051 + + true + 5052 + diff --git a/src/org/traccar/ServerManager.java b/src/org/traccar/ServerManager.java index 593826553..2f07e2b50 100644 --- a/src/org/traccar/ServerManager.java +++ b/src/org/traccar/ServerManager.java @@ -147,6 +147,7 @@ public class ServerManager { initAplicomServer("aplicom"); initGotopServer("gotop"); initTotemServer("totem"); + initGatorServer("gator"); // Initialize web server if (Boolean.valueOf(properties.getProperty("http.enable"))) { @@ -944,4 +945,15 @@ public class ServerManager { } } + private void initGatorServer(String protocol) throws SQLException { + if (isProtocolEnabled(properties, protocol)) { + serverList.add(new TrackerServer(this, new ConnectionlessBootstrap(), protocol) { + @Override + protected void addSpecificHandlers(ChannelPipeline pipeline) { + pipeline.addLast("objectDecoder", new GatorProtocolDecoder(ServerManager.this)); + } + }); + } + } + } diff --git a/src/org/traccar/protocol/GatorProtocolDecoder.java b/src/org/traccar/protocol/GatorProtocolDecoder.java new file mode 100644 index 000000000..9fa50cc88 --- /dev/null +++ b/src/org/traccar/protocol/GatorProtocolDecoder.java @@ -0,0 +1,141 @@ +/* + * Copyright 2013 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 java.util.Calendar; +import java.util.TimeZone; +import org.jboss.netty.buffer.ChannelBuffer; +import org.jboss.netty.channel.Channel; +import org.jboss.netty.channel.ChannelHandlerContext; +import org.traccar.BaseProtocolDecoder; +import org.traccar.ServerManager; +import org.traccar.helper.ChannelBufferTools; +import org.traccar.helper.Log; +import org.traccar.model.ExtendedInfoFormatter; +import org.traccar.model.Position; + +public class GatorProtocolDecoder extends BaseProtocolDecoder { + + public GatorProtocolDecoder(ServerManager serverManager) { + super(serverManager); + } + + private static final int PACKET_HEARTBEAT = 0x21; + private static final int PACKET_POSITION_DATA = 0x80; + private static final int PACKET_ROLLCALL_RESPONSE = 0x81; + private static final int PACKET_ALARM_DATA = 0x82; + private static final int PACKET_TERMINAL_STATUS = 0x83; + private static final int PACKET_MESSAGE = 0x84; + private static final int PACKET_TERMINAL_ANSWER = 0x85; + private static final int PACKET_BLIND_AREA = 0x8E; + private static final int PACKET_PICTURE_FRAME = 0x54; + private static final int PACKET_CAMERA_RESPONSE = 0x56; + private static final int PACKET_PICTURE_DATA = 0x57; + + private double readCoordinate(ChannelBuffer buf) { + int b1 = buf.readUnsignedByte(); + int b2 = buf.readUnsignedByte(); + int b3 = buf.readUnsignedByte(); + int b4 = buf.readUnsignedByte(); + + double value = (b2 & 0xf) * 10 + (b3 >> 4); + value += (((b3 & 0xf) * 10 + (b4 >> 4)) * 10 + (b4 & 0xf)) / 1000.0; + value /= 60; + value += ((b1 >> 4 & 0x7) * 10 + (b1 & 0xf)) * 10 + (b2 >> 4); + + if ((b1 & 0x80) != 0) { + value = -value; + } + + return value; + } + + @Override + protected Object decode( + ChannelHandlerContext ctx, Channel channel, Object msg) + throws Exception { + + ChannelBuffer buf = (ChannelBuffer) msg; + + buf.skipBytes(2); // header + int type = buf.readUnsignedByte(); + buf.readUnsignedShort(); // length + + // Pseudo IP address + String id = String.valueOf(buf.readUnsignedInt()); + + if (type == PACKET_POSITION_DATA || + type == PACKET_ROLLCALL_RESPONSE || + type == PACKET_ALARM_DATA || + type == PACKET_BLIND_AREA) { + + // Create new position + Position position = new Position(); + ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter("gator"); + + // Identification + try { + position.setDeviceId(getDataManager().getDeviceByImei(id).getId()); + } catch(Exception error) { + Log.warning("Unknown device - " + id); + } + + // Date and time + Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC")); + time.clear(); + time.set(Calendar.YEAR, 2000 + ChannelBufferTools.readHexInteger(buf, 2)); + time.set(Calendar.MONTH, ChannelBufferTools.readHexInteger(buf, 2) - 1); + time.set(Calendar.DAY_OF_MONTH, ChannelBufferTools.readHexInteger(buf, 2)); + time.set(Calendar.HOUR, ChannelBufferTools.readHexInteger(buf, 2)); + time.set(Calendar.MINUTE, ChannelBufferTools.readHexInteger(buf, 2)); + time.set(Calendar.SECOND, ChannelBufferTools.readHexInteger(buf, 2)); + position.setTime(time.getTime()); + + // Location + position.setLatitude(readCoordinate(buf)); + position.setLongitude(readCoordinate(buf)); + position.setSpeed(ChannelBufferTools.readHexInteger(buf, 4) * 0.539957); + position.setCourse((double) ChannelBufferTools.readHexInteger(buf, 4)); + position.setAltitude(0.0); + + // Flags + int flags = buf.readUnsignedByte(); + position.setValid((flags & 0x80) != 0); + extendedInfo.set("satellites", flags & 0x0f); + + // Status + extendedInfo.set("status", buf.readUnsignedByte()); + + // Key switch + extendedInfo.set("key", buf.readUnsignedByte()); + + // Oil + extendedInfo.set("oil", buf.readUnsignedShort() / 10.0); + + // Power + position.setPower(buf.readUnsignedByte() + buf.readUnsignedByte() / 100.0); + + // Milage + extendedInfo.set("milage", buf.readUnsignedInt()); + + position.setExtendedInfo(extendedInfo.toString()); + return position; + } + + return null; + } + +} diff --git a/test/org/traccar/protocol/GatorProtocolDecoderTest.java b/test/org/traccar/protocol/GatorProtocolDecoderTest.java new file mode 100644 index 000000000..6f1d5b5ea --- /dev/null +++ b/test/org/traccar/protocol/GatorProtocolDecoderTest.java @@ -0,0 +1,21 @@ +package org.traccar.protocol; + +import org.jboss.netty.buffer.ChannelBuffers; +import static org.junit.Assert.assertNotNull; +import org.junit.Test; +import org.traccar.helper.ChannelBufferTools; + +public class GatorProtocolDecoderTest { + + @Test + public void testDecode() throws Exception { + + GatorProtocolDecoder decoder = new GatorProtocolDecoder(null); + decoder.setDataManager(new TestDataManager()); + + int[] buf1 = {0x24,0x24,0x81,0x00,0x23,0x0C,0xA2,0x32,0x85,0x10,0x03,0x06,0x14,0x59,0x07,0x02,0x23,0x46,0x90,0x11,0x35,0x29,0x47,0x00,0x00,0x00,0x00,0xC0,0x40,0x01,0x01,0x2C,0x0E,0x11,0x00,0x00,0x00,0x21,0xCB,0x0D}; + assertNotNull(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertArray(buf1)))); + + } + +} -- cgit v1.2.3