From cf4a07510de9b954c3f7393d54206eece7d6ad4a Mon Sep 17 00:00:00 2001
From: feiyu02 <risaku@163.com>
Date: 星期三, 08 一月 2025 17:30:10 +0800
Subject: [PATCH] 1. 新增卫星遥测正方形网格顶点计算逻辑

---
 src/main/kotlin/com/flightfeather/uav/socket/UAVByteDataDecoder.kt |   26 +++++++++++++++-----------
 1 files changed, 15 insertions(+), 11 deletions(-)

diff --git a/src/main/kotlin/com/flightfeather/uav/socket/UAVByteDataDecoder.kt b/src/main/kotlin/com/flightfeather/uav/socket/UAVByteDataDecoder.kt
index 937060f..9b22dbf 100644
--- a/src/main/kotlin/com/flightfeather/uav/socket/UAVByteDataDecoder.kt
+++ b/src/main/kotlin/com/flightfeather/uav/socket/UAVByteDataDecoder.kt
@@ -1,9 +1,9 @@
 package com.flightfeather.uav.socket
 
+import com.flightfeather.uav.socket.decoder.DataPackageDecoder
 import io.netty.buffer.ByteBuf
 import io.netty.channel.ChannelHandlerContext
 import io.netty.handler.codec.ByteToMessageDecoder
-import java.lang.StringBuilder
 
 /**
  * @author riku
@@ -13,11 +13,13 @@
 class UAVByteDataDecoder : ByteToMessageDecoder() {
 
     companion object {
-        private const val HEAD_BYTES = 2//鏁版嵁澶存墍鍗犻暱搴�
-        private const val LENGTH_BYTES = 1//鏁版嵁浣嶆暟鎵�鍗犻暱搴�
-        private const val BCC_BYTES = 2//鏍¢獙鐮侀暱搴�
-        const val BASE_LENGTH = HEAD_BYTES + LENGTH_BYTES + BCC_BYTES
+        const val BASE_LENGTH = DataPackageDecoder.HEAD_BYTES + DataPackageDecoder.COMMAND_UNIT_BYTES +
+                DataPackageDecoder.DEVICE_CODE_BYTES + DataPackageDecoder.DATA_LENGTH + DataPackageDecoder.BCC_BYTES
         const val HEAD1 = 0x01.toByte()
+        const val COMMAND_1 = 0x04.toByte()
+        const val COMMAND_2 = 0x05.toByte()
+        const val HEAD_LENGTH = DataPackageDecoder.HEAD_BYTES + DataPackageDecoder.COMMAND_UNIT_BYTES +
+                DataPackageDecoder.DEVICE_CODE_BYTES
     }
 
     override fun decode(p0: ChannelHandlerContext?, p1: ByteBuf?, p2: MutableList<Any>?) {
@@ -41,11 +43,13 @@
                     // 鏍囪鍖呭ご寮�濮嬬殑index
                     it.markReaderIndex()
                     // 璇诲埌浜嗗崗璁殑寮�濮嬫爣蹇楋紝缁撴潫while寰幆
-                    val b = ByteArray(2)
+                    val b = ByteArray(HEAD_LENGTH)
                     it.readBytes(b)
-                    if (b[0] == HEAD1) {
-                        dataList.add(b[0])
-                        dataList.add(b[1])
+                    if (b[0] == HEAD1 &&
+                        (b[1] == COMMAND_1 || b[1] == COMMAND_2)) {
+                        b.forEach {b ->
+                            dataList.add(b)
+                        }
                         break
                     }
 
@@ -69,14 +73,14 @@
                 //鏁版嵁鍗曞厓鐨勯暱搴�
                 val length = getDataUnitLength(it, dataList)
                 // 鍒ゆ柇璇锋眰鏁版嵁鍗曞厓鏁版嵁鍙奫LENGTH_BYTES]涓瓧鑺傜殑鏍¢獙鐮佹槸鍚﹀埌榻�
-                if (it.readableBytes() < length + BCC_BYTES) {
+                if (it.readableBytes() < length + DataPackageDecoder.BCC_BYTES) {
                     // 杩樺師璇绘寚閽�
                     it.readerIndex(beginReader)
                     return
                 }
 
                 //璇诲彇鏁版嵁鍗曞厓鍜屾牎楠岀爜鏁版嵁
-                ByteArray(length + BCC_BYTES).apply {
+                ByteArray(length + DataPackageDecoder.BCC_BYTES).apply {
                     it.readBytes(this)
                 }.forEach {b ->
                     dataList.add(b)

--
Gitblit v1.9.3