From 572dfddfb64f99dbfde60fda628bba327c245465 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Tue, 19 Mar 2013 22:15:35 +1300 Subject: Add Galileo protocol --- default.cfg | 4 + src/org/traccar/ServerManager.java | 15 ++ src/org/traccar/protocol/GalileoFrameDecoder.java | 47 ++++++ .../traccar/protocol/GalileoProtocolDecoder.java | 169 +++++++++++++++++++++ src/org/traccar/protocol/Gt02ProtocolDecoder.java | 9 -- .../protocol/GalileoProtocolDecoderTest.java | 20 +++ 6 files changed, 255 insertions(+), 9 deletions(-) create mode 100644 src/org/traccar/protocol/GalileoFrameDecoder.java create mode 100644 src/org/traccar/protocol/GalileoProtocolDecoder.java create mode 100644 test/org/traccar/protocol/GalileoProtocolDecoderTest.java diff --git a/default.cfg b/default.cfg index 3ede240d7..4240bf429 100644 --- a/default.cfg +++ b/default.cfg @@ -197,4 +197,8 @@ true 5033 + + true + 5034 + diff --git a/src/org/traccar/ServerManager.java b/src/org/traccar/ServerManager.java index 39e6a8330..9416c4183 100644 --- a/src/org/traccar/ServerManager.java +++ b/src/org/traccar/ServerManager.java @@ -139,6 +139,7 @@ public class ServerManager { initSyrusServer("syrus"); initVt300Server("vt300"); initCellocatorServer("cellocator"); + initGalileoServer("galileo"); // Initialize web server if (Boolean.valueOf(properties.getProperty("http.enable"))) { @@ -732,4 +733,18 @@ public class ServerManager { } } + private void initGalileoServer(String protocol) throws SQLException { + if (isProtocolEnabled(properties, protocol)) { + TrackerServer server = new TrackerServer(this, new ServerBootstrap(), protocol) { + @Override + protected void addSpecificHandlers(ChannelPipeline pipeline) { + pipeline.addLast("frameDecoder", new GalileoFrameDecoder()); + pipeline.addLast("objectDecoder", new GalileoProtocolDecoder(ServerManager.this)); + } + }; + server.setEndianness(ByteOrder.LITTLE_ENDIAN); + serverList.add(server); + } + } + } diff --git a/src/org/traccar/protocol/GalileoFrameDecoder.java b/src/org/traccar/protocol/GalileoFrameDecoder.java new file mode 100644 index 000000000..41a895553 --- /dev/null +++ b/src/org/traccar/protocol/GalileoFrameDecoder.java @@ -0,0 +1,47 @@ +/* + * 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 org.jboss.netty.buffer.ChannelBuffer; +import org.jboss.netty.channel.Channel; +import org.jboss.netty.channel.ChannelHandlerContext; +import org.jboss.netty.handler.codec.frame.FrameDecoder; + +public class GalileoFrameDecoder extends FrameDecoder { + + private static final int MESSAGE_MINIMUM_LENGTH = 5; + + @Override + protected Object decode( + ChannelHandlerContext ctx, + Channel channel, + ChannelBuffer buf) throws Exception { + + // Check minimum length + if (buf.readableBytes() < MESSAGE_MINIMUM_LENGTH) { + return null; + } + + // Read packet + int length = buf.getUnsignedShort(buf.readerIndex() + 1) & 0x7fff; + if (buf.readableBytes() >= (length + MESSAGE_MINIMUM_LENGTH)) { + return buf.readBytes(length + MESSAGE_MINIMUM_LENGTH); + } + + return null; + } + +} diff --git a/src/org/traccar/protocol/GalileoProtocolDecoder.java b/src/org/traccar/protocol/GalileoProtocolDecoder.java new file mode 100644 index 000000000..e4b80777e --- /dev/null +++ b/src/org/traccar/protocol/GalileoProtocolDecoder.java @@ -0,0 +1,169 @@ +/* + * 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.nio.ByteOrder; +import java.nio.charset.Charset; +import java.util.Calendar; +import java.util.Date; +import java.util.HashMap; +import java.util.Map; +import java.util.TimeZone; +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.ServerManager; +import org.traccar.helper.Log; +import org.traccar.model.Position; + +public class GalileoProtocolDecoder extends BaseProtocolDecoder { + + public GalileoProtocolDecoder(ServerManager serverManager) { + super(serverManager); + } + + private static final Map tagLengthMap = new HashMap(); + + static { + int[] l1 = {0x01,0x02,0x35,0x43,0xc4,0xc5,0xc6,0xc7,0xc8,0xc9,0xca,0xcb,0xcc,0xcd,0xce,0xcf,0xd0,0xd1,0xd2,0xd5}; + int[] l2 = {0x04,0x10,0x34,0x40,0x41,0x42,0x45,0x46,0x50,0x51,0x52,0x53,0x58,0x59,0x70,0x71,0x72,0x73,0x74,0x75,0x76,0x77,0xd6,0xd7,0xd8,0xd9,0xda}; + int[] l4 = {0x20,0x33,0x44,0x90,0xc0,0xc1,0xc2,0xc3,0xd3,0xd4,0xdb,0xdc,0xdd,0xde,0xdf}; + for (int i : l1) { tagLengthMap.put(i, 1); } + for (int i : l2) { tagLengthMap.put(i, 2); } + for (int i : l4) { tagLengthMap.put(i, 4); } + } + + private static int getTagLength(int tag) { + return tagLengthMap.get(tag); + } + + 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 TAG_IMEI = 0x03; + private static final int TAG_DATE = 0x20; + private static final int TAG_COORDINATES = 0x30; + private static final int TAG_SPEED_COURSE = 0x33; + private static final int TAG_ALTITUDE = 0x34; + private static final int TAG_STATUS = 0x40; + private static final int TAG_POWER = 0x41; + private static final int TAG_BATTERY = 0x42; + private static final int TAG_MILAGE = 0xd4; + + + private void sendReply(Channel channel, int checksum) { + ChannelBuffer reply = ChannelBuffers.directBuffer(ByteOrder.LITTLE_ENDIAN, 3); + reply.writeByte(0x02); + reply.writeShort((short) checksum); + if (channel != null) { + channel.write(reply); + } + } + + @Override + protected Object decode( + ChannelHandlerContext ctx, Channel channel, Object msg) + throws Exception { + + ChannelBuffer buf = (ChannelBuffer) msg; + + buf.readUnsignedByte(); // header + int length = buf.readUnsignedShort() & 0x7fff + 3; + + // Create new position + Position position = new Position(); + StringBuilder extendedInfo = new StringBuilder("galileo"); + + while (buf.readerIndex() < length) { + int tag = buf.readUnsignedByte(); + switch (tag) { + + case TAG_IMEI: + String imei = buf.toString(buf.readerIndex(), 15, Charset.defaultCharset()); + buf.skipBytes(imei.length()); + try { + position.setDeviceId(getDataManager().getDeviceByImei(imei).getId()); + } catch(Exception error) { + Log.warning("Unknown device - " + imei); + } + break; + + case TAG_DATE: + position.setTime(new Date(buf.readUnsignedInt() * 1000)); + break; + + case TAG_COORDINATES: + position.setValid((buf.readUnsignedByte() & 0xf0) == 0x00); + position.setLatitude(buf.readInt() / 1000000.0); + position.setLongitude(buf.readInt() / 1000000.0); + break; + + case TAG_SPEED_COURSE: + position.setSpeed(buf.readUnsignedShort() * 0.0539957); + position.setCourse(buf.readUnsignedShort() * 0.1); + break; + + case TAG_ALTITUDE: + position.setAltitude((double) buf.readShort()); + break; + + case TAG_STATUS: + extendedInfo.append(""); + extendedInfo.append(buf.readUnsignedShort()); + extendedInfo.append(""); + break; + + case TAG_POWER: + position.setPower((double) buf.readUnsignedShort()); + break; + + case TAG_BATTERY: + extendedInfo.append(""); + extendedInfo.append(buf.readUnsignedShort()); + extendedInfo.append(""); + break; + + case TAG_MILAGE: + extendedInfo.append(""); + extendedInfo.append(buf.readUnsignedInt()); + extendedInfo.append(""); + break; + + default: + buf.skipBytes(getTagLength(tag)); + break; + + } + } + + sendReply(channel, buf.readUnsignedShort()); + + position.setExtendedInfo(extendedInfo.toString()); + return position; + } + +} diff --git a/src/org/traccar/protocol/Gt02ProtocolDecoder.java b/src/org/traccar/protocol/Gt02ProtocolDecoder.java index 16b2955d5..22402ce45 100644 --- a/src/org/traccar/protocol/Gt02ProtocolDecoder.java +++ b/src/org/traccar/protocol/Gt02ProtocolDecoder.java @@ -26,14 +26,8 @@ import org.traccar.ServerManager; import org.traccar.helper.Log; import org.traccar.model.Position; -/** - * T55 tracker protocol decoder - */ public class Gt02ProtocolDecoder extends BaseProtocolDecoder { - /** - * Initialize - */ public Gt02ProtocolDecoder(ServerManager serverManager) { super(serverManager); } @@ -53,9 +47,6 @@ public class Gt02ProtocolDecoder extends BaseProtocolDecoder { private static final int MSG_HEARTBEAT = 0x1A; private static final int MSG_DATA = 0x10; - /** - * Decode message - */ @Override protected Object decode( ChannelHandlerContext ctx, Channel channel, Object msg) diff --git a/test/org/traccar/protocol/GalileoProtocolDecoderTest.java b/test/org/traccar/protocol/GalileoProtocolDecoderTest.java new file mode 100644 index 000000000..d1706e5be --- /dev/null +++ b/test/org/traccar/protocol/GalileoProtocolDecoderTest.java @@ -0,0 +1,20 @@ +package org.traccar.protocol; + +import org.jboss.netty.buffer.ChannelBuffers; +import static org.junit.Assert.assertNotNull; +import org.junit.Test; + +public class GalileoProtocolDecoderTest { + + @Test + public void testDecode() throws Exception { + + GalileoProtocolDecoder decoder = new GalileoProtocolDecoder(null); + decoder.setDataManager(new TestDataManager()); + + /*byte[] buf1 = {0x00}; + assertNotNull(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(buf1)));*/ + + } + +} -- cgit v1.2.3