Support command response

2 files changed, 93 insertions, 71 deletions

diff --git a/src/main/java/org/traccar/protocol/T800xProtocolDecoder.java b/src/main/java/org/traccar/protocol/T800xProtocolDecoder.java
index fc7b88b08..28fd7937d 100644
--- a/src/main/java/org/traccar/protocol/T800xProtocolDecoder.java
+++ b/src/main/java/org/traccar/protocol/T800xProtocolDecoder.java
@@ -32,6 +32,7 @@ import org.traccar.model.Network;
 import org.traccar.model.Position;
 
 import java.net.SocketAddress;
+import java.nio.charset.StandardCharsets;
 
 public class T800xProtocolDecoder extends BaseProtocolDecoder {
 
@@ -101,7 +102,6 @@ public class T800xProtocolDecoder extends BaseProtocolDecoder {
         buf.readUnsignedShort(); // length
         int index = buf.readUnsignedShort();
         ByteBuf imei = buf.readSlice(8);
-        int alarm = 0;
 
         DeviceSession deviceSession = getDeviceSession(
                 channel, remoteAddress, ByteBufUtil.hexDump(imei).substring(1));
@@ -111,96 +111,118 @@ public class T800xProtocolDecoder extends BaseProtocolDecoder {
 
         if (type == MSG_GPS || type == MSG_ALARM) {
 
+            return decodePosition(channel, deviceSession, buf, header, type, index, imei);
+
+        } else if (type == MSG_COMMAND) {
+
             Position position = new Position(getProtocolName());
             position.setDeviceId(deviceSession.getDeviceId());
 
-            position.set(Position.KEY_INDEX, index);
+            getLastLocation(position, null);
+
+            buf.readUnsignedByte(); // protocol number
 
-            buf.readUnsignedShort(); // acc on interval
-            buf.readUnsignedShort(); // acc off interval
-            buf.readUnsignedByte(); // angle compensation
-            buf.readUnsignedShort(); // distance compensation
+            position.set(Position.KEY_RESULT, buf.toString(StandardCharsets.UTF_16LE));
 
-            position.set(Position.KEY_RSSI, BitUtil.to(buf.readUnsignedShort(), 7));
+            sendResponse(channel, header, type, index, imei, 0);
 
-            int status = buf.readUnsignedByte();
-            position.set(Position.KEY_SATELLITES, BitUtil.to(status, 5));
+            return position;
 
-            buf.readUnsignedByte(); // gsensor manager status
-            buf.readUnsignedByte(); // other flags
-            buf.readUnsignedByte(); // heartbeat
-            buf.readUnsignedByte(); // relay status
-            buf.readUnsignedShort(); // drag alarm setting
+        }
 
-            int io = buf.readUnsignedShort();
-            position.set(Position.KEY_IGNITION, BitUtil.check(io, 14));
-            position.set("ac", BitUtil.check(io, 13));
+        sendResponse(channel, header, type, index, imei, 0);
 
-            position.set(Position.PREFIX_ADC + 1, buf.readUnsignedShort());
-            position.set(Position.PREFIX_ADC + 2, buf.readUnsignedShort());
+        return null;
+    }
 
-            alarm = buf.readUnsignedByte();
-            position.set(Position.KEY_ALARM, decodeAlarm(alarm));
+    private Position decodePosition(
+            Channel channel, DeviceSession deviceSession,
+            ByteBuf buf, short header, int type, int index, ByteBuf imei) {
 
-            buf.readUnsignedByte(); // reserved
+        Position position = new Position(getProtocolName());
+        position.setDeviceId(deviceSession.getDeviceId());
 
-            position.set(Position.KEY_ODOMETER, buf.readUnsignedInt());
+        position.set(Position.KEY_INDEX, index);
 
-            int battery = BcdUtil.readInteger(buf, 2);
-            if (battery == 0) {
-                battery = 100;
-            }
-            position.set(Position.KEY_BATTERY, battery);
-
-            DateBuilder dateBuilder = new DateBuilder()
-                    .setYear(BcdUtil.readInteger(buf, 2))
-                    .setMonth(BcdUtil.readInteger(buf, 2))
-                    .setDay(BcdUtil.readInteger(buf, 2))
-                    .setHour(BcdUtil.readInteger(buf, 2))
-                    .setMinute(BcdUtil.readInteger(buf, 2))
-                    .setSecond(BcdUtil.readInteger(buf, 2));
-
-            if (BitUtil.check(status, 6)) {
-
-                position.setValid(!BitUtil.check(status, 7));
-                position.setTime(dateBuilder.getDate());
-                position.setAltitude(buf.readFloatLE());
-                position.setLongitude(buf.readFloatLE());
-                position.setLatitude(buf.readFloatLE());
-                position.setSpeed(UnitsConverter.knotsFromKph(BcdUtil.readInteger(buf, 4) * 0.1));
-                position.setCourse(buf.readUnsignedShort());
-
-            } else {
-
-                getLastLocation(position, dateBuilder.getDate());
-
-                int mcc = buf.readUnsignedShortLE();
-                int mnc = buf.readUnsignedShortLE();
-
-                if (mcc != 0xffff && mnc != 0xffff) {
-                    Network network = new Network();
-                    for (int i = 0; i < 3; i++) {
-                        network.addCellTower(CellTower.from(
-                                mcc, mnc, buf.readUnsignedShortLE(), buf.readUnsignedShortLE()));
-                    }
-                    position.setNetwork(network);
-                }
+        buf.readUnsignedShort(); // acc on interval
+        buf.readUnsignedShort(); // acc off interval
+        buf.readUnsignedByte(); // angle compensation
+        buf.readUnsignedShort(); // distance compensation
 
-            }
+        position.set(Position.KEY_RSSI, BitUtil.to(buf.readUnsignedShort(), 7));
 
-            if (buf.readableBytes() >= 2) {
-                position.set(Position.KEY_POWER, BcdUtil.readInteger(buf, 4) * 0.01);
-            }
+        int status = buf.readUnsignedByte();
+        position.set(Position.KEY_SATELLITES, BitUtil.to(status, 5));
 
-            sendResponse(channel, header, type, index, imei, alarm);
+        buf.readUnsignedByte(); // gsensor manager status
+        buf.readUnsignedByte(); // other flags
+        buf.readUnsignedByte(); // heartbeat
+        buf.readUnsignedByte(); // relay status
+        buf.readUnsignedShort(); // drag alarm setting
 
-            return position;
+        int io = buf.readUnsignedShort();
+        position.set(Position.KEY_IGNITION, BitUtil.check(io, 14));
+        position.set("ac", BitUtil.check(io, 13));
 
+        position.set(Position.PREFIX_ADC + 1, buf.readUnsignedShort());
+        position.set(Position.PREFIX_ADC + 2, buf.readUnsignedShort());
+
+        int alarm = buf.readUnsignedByte();
+        position.set(Position.KEY_ALARM, decodeAlarm(alarm));
+
+        buf.readUnsignedByte(); // reserved
+
+        position.set(Position.KEY_ODOMETER, buf.readUnsignedInt());
+
+        int battery = BcdUtil.readInteger(buf, 2);
+        if (battery == 0) {
+            battery = 100;
+        }
+        position.set(Position.KEY_BATTERY, battery);
+
+        DateBuilder dateBuilder = new DateBuilder()
+                .setYear(BcdUtil.readInteger(buf, 2))
+                .setMonth(BcdUtil.readInteger(buf, 2))
+                .setDay(BcdUtil.readInteger(buf, 2))
+                .setHour(BcdUtil.readInteger(buf, 2))
+                .setMinute(BcdUtil.readInteger(buf, 2))
+                .setSecond(BcdUtil.readInteger(buf, 2));
+
+        if (BitUtil.check(status, 6)) {
+
+            position.setValid(!BitUtil.check(status, 7));
+            position.setTime(dateBuilder.getDate());
+            position.setAltitude(buf.readFloatLE());
+            position.setLongitude(buf.readFloatLE());
+            position.setLatitude(buf.readFloatLE());
+            position.setSpeed(UnitsConverter.knotsFromKph(BcdUtil.readInteger(buf, 4) * 0.1));
+            position.setCourse(buf.readUnsignedShort());
+
+        } else {
+
+            getLastLocation(position, dateBuilder.getDate());
+
+            int mcc = buf.readUnsignedShortLE();
+            int mnc = buf.readUnsignedShortLE();
+
+            if (mcc != 0xffff && mnc != 0xffff) {
+                Network network = new Network();
+                for (int i = 0; i < 3; i++) {
+                    network.addCellTower(CellTower.from(
+                            mcc, mnc, buf.readUnsignedShortLE(), buf.readUnsignedShortLE()));
+                }
+                position.setNetwork(network);
+            }
+
+        }
+
+        if (buf.readableBytes() >= 2) {
+            position.set(Position.KEY_POWER, BcdUtil.readInteger(buf, 4) * 0.01);
         }
 
         sendResponse(channel, header, type, index, imei, alarm);
 
-        return null;
+        return position;
     }
 
 }
diff --git a/src/main/java/org/traccar/protocol/T800xProtocolEncoder.java b/src/main/java/org/traccar/protocol/T800xProtocolEncoder.java
index 1d0f3dabe..34f30b147 100644
--- a/src/main/java/org/traccar/protocol/T800xProtocolEncoder.java
+++ b/src/main/java/org/traccar/protocol/T800xProtocolEncoder.java
@@ -33,8 +33,8 @@ public class T800xProtocolEncoder extends BaseProtocolEncoder {
 
         ByteBuf buf = Unpooled.buffer();
 
-        buf.writeByte('#');
-        buf.writeByte('#');
+        buf.writeByte('%');
+        buf.writeByte('%');
         buf.writeByte(T800xProtocolDecoder.MSG_COMMAND);
         buf.writeShort(7 + 8 + 1 + content.length());
         buf.writeShort(1); // serial number