Fix Ulbotech frame and protocol decoders

1 files changed, 26 insertions, 15 deletions

diff --git a/src/org/traccar/protocol/UlbotechFrameDecoder.java b/src/org/traccar/protocol/UlbotechFrameDecoder.java
index f0671c717..09c1db717 100644
--- a/src/org/traccar/protocol/UlbotechFrameDecoder.java
+++ b/src/org/traccar/protocol/UlbotechFrameDecoder.java
@@ -33,25 +33,36 @@ public class UlbotechFrameDecoder extends FrameDecoder {
             return null;
         }
 
-        int index = buf.indexOf(buf.readerIndex() + 1, buf.writerIndex(), (byte) 0xF8);
-        if (index != -1) {
-            ChannelBuffer result = ChannelBuffers.buffer(index + 1 - buf.readerIndex());
-
-            while (buf.readerIndex() <= index) {
-                int b = buf.readUnsignedByte();
-                if (b == 0xF7) {
-                    int ext = buf.readUnsignedByte();
-                    if (ext == 0x00) {
-                        result.writeByte(0xF7);
-                    } else if (ext == 0x0F) {
-                        result.writeByte(0xF8);
+        if (buf.getUnsignedByte(buf.readerIndex()) == 0xF8) {
+
+            int index = buf.indexOf(buf.readerIndex() + 1, buf.writerIndex(), (byte) 0xF8);
+            if (index != -1) {
+                ChannelBuffer result = ChannelBuffers.buffer(index + 1 - buf.readerIndex());
+
+                while (buf.readerIndex() <= index) {
+                    int b = buf.readUnsignedByte();
+                    if (b == 0xF7) {
+                        int ext = buf.readUnsignedByte();
+                        if (ext == 0x00) {
+                            result.writeByte(0xF7);
+                        } else if (ext == 0x0F) {
+                            result.writeByte(0xF8);
+                        }
+                    } else {
+                        result.writeByte(b);
                     }
-                } else {
-                    result.writeByte(b);
                 }
+
+                return result;
+            }
+
+        } else {
+
+            int index = buf.indexOf(buf.readerIndex(), buf.writerIndex(), (byte) '#');
+            if (index != -1) {
+                return buf.readBytes(index + 1 - buf.readerIndex());
             }
 
-            return result;
         }
 
         return null;