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.MixPacket; 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 sendLoginResponse(Channel channel, int type, int index, String imei) { if (channel != null) { int length=7+(imei.length()/2+1); ChannelBuffer response = ChannelBuffers.buffer(length); response.writeByte(0x23); response.writeByte(0x23); // header response.writeByte(type); response.writeByte(0x00); response.writeByte(length); // length response.writeShort(0x0001);//imei //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(); List statusList=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(); sendLoginResponse(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.readUnsignedByte()); extendedInfo.set("acc", binaryDigitalIO.charAt(1)); extendedInfo.set("ac", binaryDigitalIO.charAt(2)); buf.skipBytes(1); // 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); sendLoginResponse(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.setVoltage(getBatteryPerc(batteryVoltage)); status.setStatusType(statusType); statusList.add(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); statusList.add(status); sendLoginResponse(channel, type, index, imei); } } MixPacket mixPacket=new MixPacket(); mixPacket.setPositions(positions); mixPacket.setStatus(statusList); return mixPacket; } 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; } }