1 files changed, 42 insertions, 27 deletions

diff --git a/src/org/traccar/protocol/Arnavi4ProtocolDecoder.java b/src/org/traccar/protocol/Arnavi4ProtocolDecoder.java
index c5ec3f31f..e2a1da29f 100644
--- a/src/org/traccar/protocol/Arnavi4ProtocolDecoder.java
+++ b/src/org/traccar/protocol/Arnavi4ProtocolDecoder.java
@@ -1,3 +1,18 @@
+/*
+ * Copyright 2017 Ivan Muratov (binakot@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;
@@ -21,9 +36,6 @@ import static org.traccar.protocol.Arnavi4FrameDecoder.HEADER_VERSION_2;
 import static org.traccar.protocol.Arnavi4FrameDecoder.PACKAGE_START_SIGN;
 import static org.traccar.protocol.Arnavi4FrameDecoder.PACKAGE_END_SIGN;
 
-/**
- * Created by Ivan Muratov @binakot on 11.07.2017.
- */
 public class Arnavi4ProtocolDecoder extends BaseProtocolDecoder {
 
     private static final byte RECORD_PING = 0x00;
@@ -40,38 +52,42 @@ public class Arnavi4ProtocolDecoder extends BaseProtocolDecoder {
         super(protocol);
     }
 
-    private Position decodePosition(DeviceSession deviceSession, ChannelBuffer buf, long timestamp) {
+    private Position decodePosition(DeviceSession deviceSession, ChannelBuffer buf, int length, Date time) {
 
         final Position position = new Position();
         position.setProtocol(getProtocolName());
         position.setDeviceId(deviceSession.getDeviceId());
 
-        position.setTime(new Date(timestamp));
+        position.setTime(time);
 
-        while (buf.readableBytes() > 0) {
-            short tagId = buf.readUnsignedByte();
-            int tagValue = buf.readInt();
-            switch (tagId) {
+        int readBytes = 0;
+        while (readBytes < length) {
+            short tag = buf.readUnsignedByte();
+            switch (tag) {
                 case TAG_LATITUDE:
-                    position.setLatitude(Float.intBitsToFloat(tagValue));
+                    position.setLatitude(buf.readFloat());
                     position.setValid(true);
                     break;
 
                 case TAG_LONGITUDE:
-                    position.setLongitude(Float.intBitsToFloat(tagValue));
+                    position.setLongitude(buf.readFloat());
                     position.setValid(true);
                     break;
 
                 case TAG_COORD_PARAMS:
-                    position.setSpeed((tagValue >> 24) * 1.852);
-                    position.set(Position.KEY_SATELLITES, (tagValue >> 16 & 0x0F) + (tagValue >> 20 & 0x0F));
-                    position.setAltitude((tagValue >> 8 & 0xFF) * 10.0);
-                    position.setCourse((tagValue & 0xFF) * 2.0);
+                    position.setCourse(buf.readUnsignedByte() * 2.0);
+                    position.setAltitude(buf.readUnsignedByte() * 10.0);
+                    byte satellites = buf.readByte();
+                    position.set(Position.KEY_SATELLITES, satellites & 0x0F + (satellites >> 4) & 0x0F); // gps + glonass
+                    position.setSpeed(buf.readByte() * 1.852);
                     break;
 
                 default:
-                    break; // Skip other tags
+                    buf.readBytes(4); // Skip other tags
+                    break;
             }
+
+            readBytes += 5; // 1 byte tag + 4 bytes value
         }
 
         return position;
@@ -127,37 +143,36 @@ public class Arnavi4ProtocolDecoder extends BaseProtocolDecoder {
 
             List<Position> positions = new LinkedList<>();
 
-            int parcelNumber = buf.readUnsignedByte();
+            int index = buf.readUnsignedByte();
 
-            byte recordStartSign = buf.readByte();
-            while (recordStartSign != PACKAGE_END_SIGN) {
-                switch (recordStartSign) {
+            byte recordType = buf.readByte();
+            while (recordType != PACKAGE_END_SIGN) {
+                switch (recordType) {
                     case RECORD_PING:
                     case RECORD_DATA:
                     case RECORD_TEXT:
                     case RECORD_FILE:
                     case RECORD_BINARY:
                         int length = buf.readUnsignedShort();
-                        long timestamp = buf.readUnsignedInt() * 1000;
-                        ChannelBuffer recordBuf = buf.readBytes(length);
+                        Date time = new Date(buf.readUnsignedInt() * 1000);
 
-                        if (recordStartSign == RECORD_DATA) {
-                            positions.add(decodePosition(deviceSession, recordBuf, timestamp));
+                        if (recordType == RECORD_DATA) {
+                            positions.add(decodePosition(deviceSession, buf, length, time));
                         }
 
                         buf.readUnsignedByte(); // crc
                         break;
 
                     default:
-                        throw new IllegalArgumentException("unsupported record type");
+                        return null; // Unsupported types of package
                 }
 
-                recordStartSign = buf.readByte();
+                recordType = buf.readByte();
             }
 
             if (channel != null) {
                 final ChannelBuffer response = ChannelBuffers.dynamicBuffer(ByteOrder.LITTLE_ENDIAN, 4);
-                response.writeBytes(new byte[]{0x7B, 0x00, (byte) parcelNumber, 0x7D});
+                response.writeBytes(new byte[]{0x7B, 0x00, (byte) index, 0x7D});
                 channel.write(response);
             }