From ba4af96c2b771e3984887de0a4d2d7338aed1270 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Sat, 18 Jan 2014 19:07:39 +1300 Subject: Implement KHD protocol --- src/org/traccar/ServerManager.java | 13 ++ src/org/traccar/helper/ChannelBufferTools.java | 22 +++ src/org/traccar/helper/Crc.java | 8 ++ src/org/traccar/protocol/GatorProtocolDecoder.java | 22 +-- src/org/traccar/protocol/KhdProtocolDecoder.java | 152 +++++++++++++++++++++ 5 files changed, 197 insertions(+), 20 deletions(-) create mode 100644 src/org/traccar/protocol/KhdProtocolDecoder.java (limited to 'src') diff --git a/src/org/traccar/ServerManager.java b/src/org/traccar/ServerManager.java index cd8a670ce..8e2465a2b 100644 --- a/src/org/traccar/ServerManager.java +++ b/src/org/traccar/ServerManager.java @@ -159,6 +159,7 @@ public class ServerManager { initOsmAndServer("osmand"); initEasyTrackServer("easytrack"); initTaipServer("taip"); + initKhdServer("khd"); // Initialize web server if (Boolean.valueOf(properties.getProperty("http.enable"))) { @@ -1031,4 +1032,16 @@ public class ServerManager { } } + private void initKhdServer(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 LengthFieldBasedFrameDecoder(256, 3, 2)); + pipeline.addLast("objectDecoder", new KhdProtocolDecoder(ServerManager.this)); + } + }); + } + } + } diff --git a/src/org/traccar/helper/ChannelBufferTools.java b/src/org/traccar/helper/ChannelBufferTools.java index c0df86bcd..ef2ebc313 100644 --- a/src/org/traccar/helper/ChannelBufferTools.java +++ b/src/org/traccar/helper/ChannelBufferTools.java @@ -97,6 +97,28 @@ public class ChannelBufferTools { return result.toString(); } + + /** + * Read BCD coded coordinate (first byte has sign bit) + */ + public static 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; + } + /** * Convert integer array to byte array diff --git a/src/org/traccar/helper/Crc.java b/src/org/traccar/helper/Crc.java index 84224a781..5a668f30a 100644 --- a/src/org/traccar/helper/Crc.java +++ b/src/org/traccar/helper/Crc.java @@ -136,6 +136,14 @@ public class Crc { } return (int) checksum.getValue(); } + + public static int xorChecksum(ByteBuffer buf) { + int checksum = 0; + for (int i = 0; i < buf.remaining(); i++) { + checksum ^= buf.get(i); + } + return checksum; + } public static String nmeaChecksum(String msg) { int checksum = 0; diff --git a/src/org/traccar/protocol/GatorProtocolDecoder.java b/src/org/traccar/protocol/GatorProtocolDecoder.java index 041e44588..b2baf455a 100644 --- a/src/org/traccar/protocol/GatorProtocolDecoder.java +++ b/src/org/traccar/protocol/GatorProtocolDecoder.java @@ -45,24 +45,6 @@ public class GatorProtocolDecoder extends BaseProtocolDecoder { 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) @@ -105,8 +87,8 @@ public class GatorProtocolDecoder extends BaseProtocolDecoder { position.setTime(time.getTime()); // Location - position.setLatitude(readCoordinate(buf)); - position.setLongitude(readCoordinate(buf)); + position.setLatitude(ChannelBufferTools.readCoordinate(buf)); + position.setLongitude(ChannelBufferTools.readCoordinate(buf)); position.setSpeed(ChannelBufferTools.readHexInteger(buf, 4) * 0.539957); position.setCourse((double) ChannelBufferTools.readHexInteger(buf, 4)); position.setAltitude(0.0); diff --git a/src/org/traccar/protocol/KhdProtocolDecoder.java b/src/org/traccar/protocol/KhdProtocolDecoder.java new file mode 100644 index 000000000..04317c442 --- /dev/null +++ b/src/org/traccar/protocol/KhdProtocolDecoder.java @@ -0,0 +1,152 @@ +/* + * Copyright 2014 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.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.ChannelBufferTools; +import org.traccar.helper.Crc; +import org.traccar.helper.Log; +import org.traccar.model.ExtendedInfoFormatter; +import org.traccar.model.Position; + +public class KhdProtocolDecoder extends BaseProtocolDecoder { + + public KhdProtocolDecoder(ServerManager serverManager) { + super(serverManager); + } + + private String readSerialNumber(ChannelBuffer buf) { + int b1 = buf.readUnsignedByte(); + int b2 = buf.readUnsignedByte(); if (b2 > 0x80) b2 -= 0x80; + int b3 = buf.readUnsignedByte(); if (b3 > 0x80) b3 -= 0x80; + int b4 = buf.readUnsignedByte(); + String serialNumber = String.format("%02d%02d%02d%02d", b1, b2, b3, b4); + return String.valueOf(Integer.valueOf(serialNumber)); + } + + private static final int MSG_LOGIN = 0xB1; + private static final int MSG_CONFIRMATION = 0x21; + private static final int MSG_ON_DEMAND = 0x81; + private static final int MSG_POSITION_UPLOAD = 0x80; + private static final int MSG_POSITION_REUPLOAD = 0x8E; + private static final int MSG_ALARM = 0x82; + private static final int MSG_REPLY = 0x85; + private static final int MSG_PERIPHERAL = 0xA3; + + @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(); // size + + if (type == MSG_ON_DEMAND || + type == MSG_POSITION_UPLOAD || + type == MSG_POSITION_REUPLOAD || + type == MSG_ALARM || + type == MSG_REPLY || + type == MSG_PERIPHERAL) { + + // Create new position + Position position = new Position(); + ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter("khd"); + + // Device identification + String id = readSerialNumber(buf); + 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(ChannelBufferTools.readCoordinate(buf)); + position.setLongitude(ChannelBufferTools.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); + + if (type == MSG_ALARM) { + + buf.skipBytes(2); + + } else { + + // Milage + extendedInfo.set("milage", buf.readUnsignedMedium()); + + // Status + buf.skipBytes(4); + + // Other + buf.skipBytes(8); + + } + + // TODO: parse extra data + + position.setExtendedInfo(extendedInfo.toString()); + return position; + } + + else if (type == MSG_LOGIN && channel != null) { + + buf.skipBytes(4); // serial number + buf.readByte(); // reserved + + ChannelBuffer response = ChannelBuffers.directBuffer(10); + response.writeByte(0x29); response.writeByte(0x29); // header + response.writeByte(MSG_CONFIRMATION); + response.writeShort(5); // size + response.writeByte(buf.readUnsignedByte()); + response.writeByte(type); + response.writeByte(0); // reserved + response.writeByte(Crc.xorChecksum(response.toByteBuffer(0, 8))); + response.writeByte(0x0D); // ending + channel.write(response); + + } + + return null; + } + +} -- cgit v1.2.3