JT600 protocol fix

1 files changed, 20 insertions, 0 deletions

diff --git a/src/org/traccar/helper/ChannelBufferTools.java b/src/org/traccar/helper/ChannelBufferTools.java
index 9139ed7ae..4f1ebb7c0 100644
--- a/src/org/traccar/helper/ChannelBufferTools.java
+++ b/src/org/traccar/helper/ChannelBufferTools.java
@@ -15,6 +15,7 @@
  */
 package org.traccar.helper;
 
+import java.util.Formatter;
 import org.jboss.netty.buffer.ChannelBuffer;
 
 /**
@@ -77,4 +78,23 @@ public class ChannelBufferTools {
         return result;
     }
 
+    /**
+     * Return hex string
+     */
+    public static String readHexString(ChannelBuffer buf, int length) {
+        
+        StringBuilder result = new StringBuilder();
+        Formatter formatter = new Formatter(result);
+        
+        for (int i = 0; i < length / 2; i++) {
+            formatter.format("%02x", buf.readByte());
+        }
+        
+        if (length % 2 == 1) {
+            int b = buf.getUnsignedByte(buf.readerIndex());
+            formatter.format("%01x", b >>> 4);
+        }
+        
+        return result.toString();
+    }
 }