From c72c0b15ea8cfd0d2642e05af94a876fe525e447 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Sun, 11 Aug 2013 01:38:22 +1200 Subject: Implement Aplicom protocol (fix #202) --- default.cfg | 8 + src/org/traccar/ServerManager.java | 30 ++- src/org/traccar/protocol/AplicomFrameDecoder.java | 59 ++++++ .../traccar/protocol/AplicomProtocolDecoder.java | 236 +++++++++++++++++++++ .../protocol/AplicomProtocolDecoderTest.java | 24 +++ 5 files changed, 356 insertions(+), 1 deletion(-) create mode 100644 src/org/traccar/protocol/AplicomFrameDecoder.java create mode 100644 src/org/traccar/protocol/AplicomProtocolDecoder.java create mode 100644 test/org/traccar/protocol/AplicomProtocolDecoderTest.java diff --git a/default.cfg b/default.cfg index 2835340d2..fbd1278a5 100644 --- a/default.cfg +++ b/default.cfg @@ -254,4 +254,12 @@ true 5047 + + true + 5048 + + + true + 5049 + diff --git a/src/org/traccar/ServerManager.java b/src/org/traccar/ServerManager.java index 0811a48be..f66eda351 100644 --- a/src/org/traccar/ServerManager.java +++ b/src/org/traccar/ServerManager.java @@ -143,6 +143,8 @@ public class ServerManager { initPt3000Server("pt3000"); initRuptelaServer("ruptela"); initTopflytechServer("topflytech"); + //initLaipacServer("laipac"); + initAplicomServer("aplicom"); // Initialize web server if (Boolean.valueOf(properties.getProperty("http.enable"))) { @@ -754,7 +756,7 @@ public class ServerManager { }); } } - + private void initWialonServer(String protocol) throws SQLException { if (isProtocolEnabled(properties, protocol)) { serverList.add(new TrackerServer(this, new ServerBootstrap(), protocol) { @@ -886,4 +888,30 @@ public class ServerManager { } } + /*private void initLaipacServer(String protocol) throws SQLException { + if (isProtocolEnabled(properties, protocol)) { + serverList.add(new TrackerServer(this, new ServerBootstrap(), protocol) { + @Override + protected void addSpecificHandlers(ChannelPipeline pipeline) { + pipeline.addLast("frameDecoder", new LineBasedFrameDecoder(1024)); + pipeline.addLast("stringDecoder", new StringDecoder()); + pipeline.addLast("stringEncoder", new StringEncoder()); + pipeline.addLast("objectDecoder", new LaipacProtocolDecoder(ServerManager.this)); + } + }); + } + }*/ + + private void initAplicomServer(String protocol) throws SQLException { + if (isProtocolEnabled(properties, protocol)) { + serverList.add(new TrackerServer(this, new ServerBootstrap(), protocol) { + @Override + protected void addSpecificHandlers(ChannelPipeline pipeline) { + pipeline.addLast("frameDecoder", new AplicomFrameDecoder()); + pipeline.addLast("objectDecoder", new AplicomProtocolDecoder(ServerManager.this)); + } + }); + } + } + } diff --git a/src/org/traccar/protocol/AplicomFrameDecoder.java b/src/org/traccar/protocol/AplicomFrameDecoder.java new file mode 100644 index 000000000..7dec3b511 --- /dev/null +++ b/src/org/traccar/protocol/AplicomFrameDecoder.java @@ -0,0 +1,59 @@ +/* + * 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 AplicomFrameDecoder extends FrameDecoder{ + + @Override + protected Object decode( + ChannelHandlerContext ctx, + Channel channel, + ChannelBuffer buf) throws Exception { + + // Check minimum length + if (buf.readableBytes() < 11) { + return null; + } + + // Read flags + int version = buf.getUnsignedByte(buf.readerIndex() + 1); + int offset = 1 + 1 + 3; + if ((version & 0x80) != 0) { + offset += 4; + } + + // Get data length + int length = buf.getUnsignedShort(buf.readerIndex() + offset); + offset += 2; + if ((version & 0x40) != 0) { + offset += 3; + } + length += offset; // add header + + // Return buffer + if (buf.readableBytes() >= length) { + return buf.readBytes(length); + } + + return null; + } + +} diff --git a/src/org/traccar/protocol/AplicomProtocolDecoder.java b/src/org/traccar/protocol/AplicomProtocolDecoder.java new file mode 100644 index 000000000..978b84b6d --- /dev/null +++ b/src/org/traccar/protocol/AplicomProtocolDecoder.java @@ -0,0 +1,236 @@ +/* + * 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.Date; +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.Log; +import org.traccar.model.ExtendedInfoFormatter; +import org.traccar.model.Position; + +public class AplicomProtocolDecoder extends BaseProtocolDecoder { + + public AplicomProtocolDecoder(ServerManager serverManager) { + super(serverManager); + } + + private static final long IMEI_BASE_TC65_V20 = 0x1437207000000L; + private static final long IMEI_BASE_TC65_V28 = 358244010000000L; + private static final long IMEI_BASE_TC65I_V11 = 0x14143B4000000L; + + private static long imeiFromUnitId(long unitId) { + if(unitId == 0) { + return 0L; + } else if(unitId < 0x1000000) { + // Assume TC65i. + long imei = IMEI_BASE_TC65I_V11 + unitId; + if(validateImei(imei)) { + return imei; + } + + // No? Maybe it's TC65 v2.8? + imei = IMEI_BASE_TC65_V28 + ((unitId + 0xA8180) & 0xFFFFFF); + if(validateImei(imei)) { + return imei; + } + + // Still no match? How about TC65 v2.0? + imei = IMEI_BASE_TC65_V20 + unitId; + if(validateImei(imei)) { + return imei; + } + } else { + // Unit ID is full IMEI, just check it. + if(validateImei(unitId)) { + return unitId; + } + } + + return unitId; + } + + private static boolean validateImei(long imei2) { + + int checksum = 0; + long remain = imei2; + + // Iterate through all meaningful digits. + for (int i = 0; remain != 0; i++) { + // Extract the rightmost digit, that is, compute + // imei modulo 10 (or remainder of imei / 10). + int digit = (int) (remain % 10); + + // For each even-positioned digit, calculate the value + // to be added to sum: Double the digit and then sum up + // the digits of the result. + // Example: 7 -> 2*7 = 14 -> 1 + 4 = 5 + if (0 != (i % 2)) { + digit = digit * 2; + if (digit >= 10) { + digit = digit - 9; + } + } + checksum = checksum + digit; + + // Remove the rightmost digit as it's already processed. + remain = remain / 10; + } + + // The IMEI is valid if the calculated checksum is dividable by 10. + return 0 == (checksum % 10); + } + + private static final int DEFAULT_SELECTOR = 0x0002FC; + + @Override + protected Object decode( + ChannelHandlerContext ctx, Channel channel, Object msg) + throws Exception { + + ChannelBuffer buf = (ChannelBuffer) msg; + + buf.readUnsignedByte(); // marker + int version = buf.readUnsignedByte(); + if ((version & 0x80) != 0) { + buf.skipBytes(4); // unit id high + } + + String imei = String.valueOf(imeiFromUnitId(buf.readUnsignedMedium())); + + buf.readUnsignedShort(); // length + + // Selector + int selector = DEFAULT_SELECTOR; // default selector + if ((version & 0x40) != 0) { + selector = buf.readUnsignedMedium(); + } + + // Create new position + Position position = new Position(); + ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter("aplicom"); + try { + position.setDeviceId(getDataManager().getDeviceByImei(imei).getId()); + } catch(Exception error) { + Log.warning("Unknown device - " + imei); + return null; + } + + // Event + extendedInfo.set("event", buf.readUnsignedByte()); + buf.readUnsignedByte(); + + // Validity + if ((selector & 0x0008) != 0) { + position.setValid((buf.readUnsignedByte() & 0x40) != 0); + } else { + return null; // no location data + } + + // Time + if ((selector & 0x0004) != 0) { + buf.skipBytes(4); // snapshot time + } + + // Location + if ((selector & 0x0008) != 0) { + position.setTime(new Date(buf.readUnsignedInt() * 1000)); + position.setLatitude(buf.readInt() / 1000000.0); + position.setLongitude(buf.readInt() / 1000000.0); + extendedInfo.set("satellites", buf.readUnsignedByte()); + } + + // Speed and heading + if ((selector & 0x0010) != 0) { + position.setSpeed(buf.readUnsignedByte() * 0.539957); + buf.readUnsignedByte(); // maximum speed + position.setCourse(buf.readUnsignedByte() * 2.0); + } else { + position.setSpeed(0.0); + position.setCourse(0.0); + } + + // Input + if ((selector & 0x0040) != 0) { + extendedInfo.set("input", buf.readUnsignedByte()); + } + + // ADC + if ((selector & 0x0020) != 0) { + extendedInfo.set("adc1", buf.readUnsignedShort()); + extendedInfo.set("adc2", buf.readUnsignedShort()); + extendedInfo.set("adc3", buf.readUnsignedShort()); + extendedInfo.set("adc4", buf.readUnsignedShort()); + } + + // Power + if ((selector & 0x8000) != 0) { + position.setPower(buf.readUnsignedShort() / 1000.0); + extendedInfo.set("battery", buf.readUnsignedShort()); + } + + // Pulse rate 1 + if ((selector & 0x10000) != 0) { + buf.readUnsignedShort(); + buf.readUnsignedInt(); + } + + // Pulse rate 2 + if ((selector & 0x20000) != 0) { + buf.readUnsignedShort(); + buf.readUnsignedInt(); + } + + // Trip 1 + if ((selector & 0x0080) != 0) { + extendedInfo.set("trip1", buf.readUnsignedInt()); + } + + // Trip 2 + if ((selector & 0x0100) != 0) { + extendedInfo.set("trip2", buf.readUnsignedInt()); + } + + // Output + if ((selector & 0x0040) != 0) { + extendedInfo.set("output", buf.readUnsignedByte()); + } + + // Button + if ((selector & 0x0200) != 0) { + buf.skipBytes(6); + } + + // Keypad + if ((selector & 0x0400) != 0) { + buf.readUnsignedByte(); + } + + // Altitude + if ((selector & 0x0800) != 0) { + position.setAltitude((double) buf.readShort()); + } else { + position.setAltitude(0.0); + } + + position.setExtendedInfo(extendedInfo.toString()); + return position; + } + +} diff --git a/test/org/traccar/protocol/AplicomProtocolDecoderTest.java b/test/org/traccar/protocol/AplicomProtocolDecoderTest.java new file mode 100644 index 000000000..a9f53c4c4 --- /dev/null +++ b/test/org/traccar/protocol/AplicomProtocolDecoderTest.java @@ -0,0 +1,24 @@ +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 AplicomProtocolDecoderTest { + + @Test + public void testDecode() throws Exception { + + AplicomProtocolDecoder decoder = new AplicomProtocolDecoder(null); + decoder.setDataManager(new TestDataManager()); + + int[] buf1 = {0x44,0xC2,0x01,0x43,0x72,0x07,0x29,0xD6,0x84,0x00,0x43,0x03,0x1f,0xff,0x71,0x91,0xC0,0x45,0x0e,0xf9,0x06,0x45,0x0e,0xf9,0x06,0x03,0xb2,0x0b,0x80,0x03,0xb2,0x0b,0x80,0x06,0x64,0x65,0xb3,0x87,0x0c,0xe3,0x0f,0x01,0x0c,0xe3,0x0c,0xe3,0x00,0x32,0x00,0x00,0x15,0x20,0x00,0x00,0x00,0x03,0x0a,0xa2,0x00,0x00,0x3b,0x13,0x00,0x00,0x00,0x32,0x03,0x00,0x00,0x0b,0xcb,0x17,0xac,0xff,0x00,0x99,0x00,0x01,0x86,0xa0,0x02}; + assertNotNull(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertArray(buf1)))); + + int[] buf2 = {0x44,0x01,0x29,0xD6,0x84,0x00,0x2b,0x07,0x00,0xC0,0x45,0x0e,0xf9,0x06,0x45,0x0e,0xf9,0x06,0x03,0xb2,0x0b,0x80,0x03,0xb2,0x0b,0x80,0x06,0x64,0x65,0xb3,0x87,0x0c,0xe3,0x0f,0x01,0x0c,0xe3,0x0c,0xe3,0x00,0x00,0x3b,0x13,0x03,0x00,0x00,0x0b,0xcb,0x17,0xa}; + assertNotNull(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertArray(buf2)))); + + } + +} -- cgit v1.2.3