From 0858303eedc1cfdc22297c3e8c013f31e0df684e Mon Sep 17 00:00:00 2001 From: Ankit Tater Date: Sat, 24 Oct 2015 12:47:34 +0530 Subject: Implementation of T880X topflytech Protocol --- src/org/traccar/protocol/T800XProtocolDecoder.java | 288 +++++++++++++++++++++ .../traccar/protocol/T800XProtocolDecoderTest.java | 32 +++ 2 files changed, 320 insertions(+) create mode 100644 src/org/traccar/protocol/T800XProtocolDecoder.java create mode 100644 test/org/traccar/protocol/T800XProtocolDecoderTest.java diff --git a/src/org/traccar/protocol/T800XProtocolDecoder.java b/src/org/traccar/protocol/T800XProtocolDecoder.java new file mode 100644 index 000000000..aff8d013a --- /dev/null +++ b/src/org/traccar/protocol/T800XProtocolDecoder.java @@ -0,0 +1,288 @@ +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.database.DataManager; +import org.traccar.helper.ChannelBufferTools; +import org.traccar.helper.Log; +import org.traccar.model.ExtendedInfoFormatter; +import org.traccar.model.Position; +import org.traccar.model.Status; + +import java.text.SimpleDateFormat; +import java.util.*; + +/** + * Created by Ankit on 21-10-2015. + */ + + +public class T800XProtocolDecoder extends BaseProtocolDecoder { + + public T800XProtocolDecoder(DataManager dataManager, String protocol, Properties properties) { + super(dataManager, protocol, properties); + } + + private final TimeZone timeZone = TimeZone.getTimeZone("UTC"); + SimpleDateFormat dateFormatGmt = new SimpleDateFormat("yyyy-MMM-dd HH:mm:ss"); + SimpleDateFormat dateFormatLocal = new SimpleDateFormat("yyyy-MMM-dd HH:mm:ss"); + + 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 = 0x01; + private static final int MSG_GPS = 0x02; + private static final int MSG_HEARTBEAT = 0x03; + private static final int MSG_ALARM = 0x04; + private static final int MSG_STATE = 0x05; + private static final int MSG_SMS = 0x06; + private static final int MSG_OBD = 0x07; + private static final int MSG_INTERACTIVE = 0x80; + private static final int MSG_DATA = 0x81; + + private Long deviceId; + + private void sendResponse(Channel channel, int type, int index, String imei) { + if (channel != null) { + ChannelBuffer response = ChannelBuffers.buffer(7+imei.getBytes().length); + response.writeByte(0x23); + response.writeByte(0x23); // header + response.writeByte(type); + response.writeByte(0x00); + response.writeByte(0x0F); // length + response.writeByte(0x00); + response.writeByte(0x01); //index + //IMEI + response.writeBytes(ChannelBufferTools.convertHexString("0" + imei)); + channel.write(response); + } + } + + @Override + protected Object decode( + ChannelHandlerContext ctx, Channel channel, Object msg) + throws Exception { + + + ChannelBuffer buf = (ChannelBuffer) msg; + + List positions=new ArrayList(); + int i=0; + while (buf.readable()){ + i++; + buf.skipBytes(2); // header + int type = buf.readUnsignedByte(); // type + buf.readShort(); // length + int index = buf.readUnsignedShort(); // index + String imei = ChannelBufferTools.readHexString(buf, 16).substring(1); // imei + + if (type == MSG_LOGIN) { + try { + deviceId = getDataManager().getDeviceByImei(imei).getId(); + sendResponse(channel, type, index, imei); // send login response + return null; + } catch (Exception error) { + Log.warning("Unknown device - " + imei); + } + } else if (deviceId != null && + (type == MSG_GPS || type == MSG_ALARM)) { + + ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter(getProtocol()); + extendedInfo.set("index", index); + + //ACC ON Interval TODO + buf.skipBytes(2); + //Acc OFF Interval TODO + buf.skipBytes(2); + + //Angel Degree TODO + buf.skipBytes(1); + + //Angel Distance TODO + buf.skipBytes(2); + + //Speed Alarm TODO + buf.skipBytes(2); + + //GPS Status TODO + String locationType = getBits(buf.readUnsignedByte()); + + //Gsensor Manager TODO + buf.skipBytes(1); + + + //Reserve Bit + buf.skipBytes(1); + + //HeartBit + buf.skipBytes(1); + + //Relay Status + buf.skipBytes(1); + + //Drag Alarm Setting + buf.skipBytes(2); + + // Digital I/O Status + String binaryDigitalIO = getBits(buf.readUnsignedShort()); + extendedInfo.set("acc", binaryDigitalIO.charAt(1)); + extendedInfo.set("ac", binaryDigitalIO.charAt(2)); + + // 2 Analog Input + buf.skipBytes(4); + + // Alarm Data + String alarmData = ChannelBufferTools.readHexString(buf, 2); + String statusType=getStatusType(alarmData); + extendedInfo.set(statusType,true); + if(type == MSG_ALARM) + { + Log.debug("ALARM"+statusType); + sendResponse(channel,type,index,imei+alarmData); + } + + // Reserve + buf.skipBytes(1); + + // Mileage + buf.skipBytes(4); + + + // Inner Battery Voltage + double batteryVoltage = Double.parseDouble(ChannelBufferTools.readHexString(buf, 2)); + extendedInfo.set("power", getBatteryPerc(batteryVoltage)); + + // Time & Date Calculation + Calendar time = Calendar.getInstance(); + time.clear(); + time.set(Calendar.YEAR, 2000 + Integer.parseInt(ChannelBufferTools.readHexString(buf, 2))); + time.set(Calendar.MONTH, (Integer.parseInt(ChannelBufferTools.readHexString(buf, 2)) - 1)); + time.set(Calendar.DAY_OF_MONTH, Integer.parseInt(ChannelBufferTools.readHexString(buf, 2))); + time.set(Calendar.HOUR_OF_DAY, Integer.parseInt(ChannelBufferTools.readHexString(buf, 2))); + time.set(Calendar.MINUTE, Integer.parseInt(ChannelBufferTools.readHexString(buf, 2))); + time.set(Calendar.SECOND, Integer.parseInt(ChannelBufferTools.readHexString(buf, 2))); + + if (locationType.charAt(1) == '1') { + Log.debug("GPS DATA"); + Position position = new Position(); + position.setDeviceId(deviceId); + position.setTime(time.getTime()); + + // Read Altitude + byte[] altitude = new byte[]{buf.readByte(), buf.readByte(), buf.readByte(), buf.readByte()}; + position.setAltitude((double) bytes2Float(altitude, 0)); + + // Read Longitude & Latitude + byte[] longitude = new byte[]{buf.readByte(), buf.readByte(), buf.readByte(), buf.readByte()}; + byte[] latitude = new byte[]{buf.readByte(), buf.readByte(), buf.readByte(), buf.readByte()}; + position.setLongitude((double) bytes2Float(longitude, 0)); + position.setLatitude((double) bytes2Float(latitude, 0)); + + // Read Speed + String str_speed = ChannelBufferTools.readHexString(buf, 4); + String result = str_speed.substring(0, 3) + "." + str_speed.substring(3); + position.setSpeed(Double.parseDouble(result) * 0.539957); + + position.setExtendedInfo(extendedInfo.toString()); + positions.add(position); + + buf.skipBytes(2); + } + else { + Log.debug("LBS DATA"); + if(type == MSG_ALARM) + { + Status status = new Status(); + status.setDate(time.getTime()); + status.setDeviceid(deviceId); + status.setStatusType(statusType); + + return status; + } + buf.skipBytes(16); + } + } else if (deviceId != null && + (type == MSG_HEARTBEAT)) { + dateFormatGmt.setTimeZone(TimeZone.getTimeZone("GMT")); + Status status = new Status(); + status.setDate(dateFormatLocal.parse(dateFormatGmt.format(new Date()))); + status.setDeviceid(deviceId); + sendResponse(channel, type, index, imei); + return status; + } + } + + return positions; + } + + + private static String getBits(int flags) { + int hexFlag = Integer.parseInt(Integer.toHexString(flags), 16); + String binaryAlarm = Integer.toBinaryString(hexFlag); + binaryAlarm = (String.format("%8s", binaryAlarm)).replace(' ', '0'); + return binaryAlarm; + } + + public static float bytes2Float(byte[] bytes, int offset) { + int value; + value = bytes[offset]; + value &= 0xff; + value |= ((long) bytes[offset + 1] << 8); + value &= 0xffff; + value |= ((long) bytes[offset + 2] << 16); + value &= 0xffffff; + value |= ((long) bytes[offset + 3] << 24); + + return Float.intBitsToFloat(value); + } + + public static int getBatteryPerc(double batteryPercentage) { + if (batteryPercentage >= 1 && batteryPercentage < 6) { + return 0; + } else if (batteryPercentage > 5 && batteryPercentage < 11) { + return 1; + } else if (batteryPercentage > 10 && batteryPercentage < 21) { + return 2; + } else if (batteryPercentage > 20 && batteryPercentage < 36) { + return 3; + } else if (batteryPercentage > 35 && batteryPercentage < 71) { + return 4; + } else if (batteryPercentage > 70 && batteryPercentage < 96) { + return 5; + } else if (batteryPercentage > 95 && batteryPercentage < 101 || batteryPercentage == 0) { + return 6; + } + return -1; + } + + private String getStatusType(String alarmCode) { + String alarmCodeString = ""; + if (alarmCode.equals("02")) { + alarmCodeString = "LBA"; + }else if (alarmCode.equals("03")) { + alarmCodeString = "SOS"; + }else if (alarmCode.equals("08")) { + alarmCodeString = "VIBALM"; + } else if (alarmCode.equals("16")) { + alarmCodeString = "PWROFF"; + } else if (alarmCode.equals("15")) { + alarmCodeString = "PWRON"; + } else { + alarmCodeString = "NDFND"; + } + return alarmCodeString; + } + +} diff --git a/test/org/traccar/protocol/T800XProtocolDecoderTest.java b/test/org/traccar/protocol/T800XProtocolDecoderTest.java new file mode 100644 index 000000000..df796013f --- /dev/null +++ b/test/org/traccar/protocol/T800XProtocolDecoderTest.java @@ -0,0 +1,32 @@ +package org.traccar.protocol; + +import junit.framework.TestCase; +import org.jboss.netty.buffer.ChannelBuffers; +import org.junit.Test; +import org.traccar.helper.ChannelBufferTools; +import org.traccar.helper.TestDataManager; + +/** + * Created by Ankit on 21-10-2015. + */ +public class T800XProtocolDecoderTest extends TestCase { + + @Test + public void testDecode() throws Exception { + + T800XProtocolDecoder decoder = new T800XProtocolDecoder(new TestDataManager(), null, null); + + assertNull(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertHexString( + "232301001500020357367031063979150208625010")))); + + /* assertNull(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertHexString( + "6767030004001A0001"))));*/ + + /* assertNull(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertHexString( + "6767070088001050E2281400FFFFFFFF02334455660333445566043344556605AA00000007334455660A334455660B334455660C4E2000000DAA0000000E334455660F3344556610AAAA000011334455661C334455661F334455662133445566423344556646334455664D334455665C334455665E33445566880000000089000000008A000000008B00000000")))); +*/ + /* verify(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ChannelBufferTools.convertHexString( + "676702001b03c5538086df0190c1790b3482df0f0157020800013beb00342401")))); +*/ + } +} \ No newline at end of file -- cgit v1.2.3