From 092d7c56bb8653075b8f4b27220e69e6bb8e5d37 Mon Sep 17 00:00:00 2001
From: ‘liusuyi’ <1951119284@qq.com>
Date: 星期四, 09 十一月 2023 16:49:26 +0800
Subject: [PATCH] 增加超脑业务

---
 src/main/java/com/ard/utils/tcp/ClientHandler.java |  141 ++++++++++++++++++++++++++++++++++-------------
 1 files changed, 102 insertions(+), 39 deletions(-)

diff --git a/src/main/java/com/ard/utils/tcp/ClientHandler.java b/src/main/java/com/ard/utils/tcp/ClientHandler.java
index b7ebb4d..0063611 100644
--- a/src/main/java/com/ard/utils/tcp/ClientHandler.java
+++ b/src/main/java/com/ard/utils/tcp/ClientHandler.java
@@ -1,11 +1,12 @@
 package com.ard.utils.tcp;
+
 import com.alibaba.fastjson2.JSON;
 import com.ard.alarm.radar.domain.ArdAlarmRadar;
 import com.ard.alarm.radar.domain.ArdEquipRadar;
 import com.ard.alarm.radar.domain.RadarAlarmData;
 import com.ard.utils.other.ByteUtils;
 import com.ard.utils.other.GisUtils;
-import com.ard.utils.mqtt.MqttConsumer;
+import com.ard.utils.mqtt.MqttProducer;
 import io.netty.buffer.ByteBuf;
 import io.netty.channel.ChannelHandlerContext;
 import io.netty.channel.ChannelId;
@@ -16,11 +17,10 @@
 import javax.xml.bind.DatatypeConverter;
 import java.net.InetSocketAddress;
 import java.text.SimpleDateFormat;
-import java.util.ArrayList;
-import java.util.Arrays;
-import java.util.List;
+import java.util.*;
 import java.util.concurrent.ScheduledFuture;
 import java.util.concurrent.TimeUnit;
+
 /**
  * @Description: 瀹㈡埛绔鐞嗗櫒
  * @ClassName: ClientHandler
@@ -41,7 +41,7 @@
      * @throws Exception
      */
     @Override
-    public void channelActive(ChannelHandlerContext ctx) throws Exception {
+    public void channelActive(ChannelHandlerContext ctx) {
         context = ctx;
         startHeartbeatTask();//寮�濮嬪彂閫佸績璺�
     }
@@ -143,7 +143,7 @@
             byte[] heart = ByteUtils.appendArrays(header, payload, payloadCrc32, footer);
 //            byte[] heart = {0x01, 0x02, 0x01, 0x10, 0x00, 0x00, 0x00, (byte) 0x83, (byte) 0x88, 0x5d, 0x71, 0x01, 0x02, 0x00};
             String hexString = DatatypeConverter.printHexBinary(heart);
-            log.debug("鍙戦�佸績璺�:" + hexString);
+            // log.debug("鍙戦�佸績璺�:" + hexString);
             message.writeBytes(heart);
             context.writeAndFlush(message);
 
@@ -169,12 +169,13 @@
             String radarName = ardEquipRadarbyte.getName();
             Double radarLongitude = ardEquipRadarbyte.getLongitude();
             Double radarLagitude = ardEquipRadarbyte.getLatitude();
+            Double radarAltitude = ardEquipRadarbyte.getAltitude();
             //region crc鏍¢獙-鐩墠浠呯敤浜庢樉绀烘牎楠岀粨鏋�
             Boolean crc32Check = MessageParsing.CRC32Check(data);
             if (!crc32Check) {
                 log.debug("CRC32鏍¢獙涓嶉�氳繃");
             } else {
-                log.debug("CRC32鏍¢獙閫氳繃");
+                //log.debug("CRC32鏍¢獙閫氳繃");
             }
             //endregion
             //log.info("鍘熷鏁版嵁:" + DatatypeConverter.printHexBinary(data));
@@ -187,10 +188,13 @@
             //  log.info("鍛戒护ID:" + DatatypeConverter.printHexBinary(cmdId));
             byte[] payloadSize = Arrays.copyOfRange(data, 2, 4);//鏈夋晥璐熻浇澶у皬
             payloadSize = ByteUtils.toLittleEndian(payloadSize);
+            //log.info("payloadSize:" + DatatypeConverter.printHexBinary(payloadSize));
             int payloadSizeToDecimal = ByteUtils.bytesToDecimal(payloadSize);
             // log.info("鏈夋晥璐熻浇澶у皬(杞暣鍨�):" + payloadSizeToDecimal);
             //endregion
             List<ArdAlarmRadar> radarAlarmInfos = new ArrayList<>();
+            //鎶芥补鏈虹姸鎬侀浄杈炬帹閫侀泦鍚�
+            List<ArdAlarmRadar> well = new ArrayList<>();
             String alarmTime = "";
             Integer targetNum = 0;
             if (Arrays.equals(cmdId, new byte[]{0x01})) {
@@ -221,13 +225,13 @@
                     // log.info("鐩爣ID:" + DatatypeConverter.printHexBinary(cmdId));
                     dwID = ByteUtils.toLittleEndian(dwID);
                     int id = ByteUtils.bytesToDecimal(dwID);
-
                     // log.info("鐩爣ID鍙凤細" + id);
 
                     byte[] iDistance = Arrays.copyOfRange(data, index + 8, index + 12);
                     iDistance = ByteUtils.toLittleEndian(iDistance);
-                    Double Distance = ByteUtils.bytesToDouble(iDistance);
-                    // log.info("鐩爣褰撳墠璺濈(m):" + Distance);
+                    double Distance = ByteUtils.bytesToDecimal(iDistance);
+                    log.debug("鐩爣褰撳墠鐩寸嚎璺濈(m):" + Distance);
+
                     //region 涓嶉渶瑕佺殑瀛楁
 //                    byte[] dwGSum = Arrays.copyOfRange(data, index + 4, index + 8);
 //                    dwGSum = toLittleEndian(dwGSum);
@@ -298,10 +302,16 @@
                     byte[] afTy = Arrays.copyOfRange(data, index + 112, index + 116);
                     afTy = ByteUtils.toLittleEndian(afTy);
                     float fTy = ByteUtils.bytesToFloat(afTy);
-                    //  log.info("鍨傜洿瑙掑害:" + fTy);
+                    log.debug("鍨傜洿瑙掑害:" + fTy);
+                    // 灏嗚搴﹁浆鎹负寮у害
+                    double thetaRadians = Math.toRadians(fTy + 90);
+                    // 浣跨敤姝e鸡鍑芥暟璁$畻瀵硅竟闀垮害
+                    Distance = Math.sin(thetaRadians) * Distance;
+                    log.debug("鐩爣鎶曞奖璺濈(m):" + Distance);
+
                     Double[] radarXY = {radarLongitude, radarLagitude};
                     Double[] alarmXY = GisUtils.CalculateCoordinates(radarXY, Distance, (double) fTx);
-                    //  log.info("鎶ヨ淇℃伅锛�" + "銆恑d銆�" + id + "銆恘ame銆�" + alarmPointName + "銆恆larmType銆�" + alarmType + "銆恆larmTime銆�" + alarmTime + "銆恉istance銆�" + Distance + "銆怭銆�" + fTx + "銆怲銆�" + fTy + "銆怷銆�" + alarmXY[0] + "銆怸銆�" + alarmXY[1]);
+                    log.debug("鎶ヨ淇℃伅锛�" + "銆恑d銆�" + id + "銆恘ame銆�" + alarmPointName + "銆恆larmType銆�" + alarmType + "銆恆larmTime銆�" + alarmTime + "銆恉istance銆�" + Distance + "銆怭銆�" + fTx + "銆怲銆�" + fTy + "銆怷銆�" + alarmXY[0] + "銆怸銆�" + alarmXY[1]);
                     ArdAlarmRadar ardAlarmRadar = new ArdAlarmRadar();
                     ardAlarmRadar.setTargetId(id);
                     ardAlarmRadar.setName(alarmPointName);
@@ -311,6 +321,21 @@
                     radarAlarmInfos.add(ardAlarmRadar);
                 }
                 //endregion
+                if (StringUtils.isEmpty(alarmTime)) {
+                    return;
+                }
+                if (targetNum == 0) {
+                    return;
+                }
+                RadarAlarmData radarAlarmData = new RadarAlarmData();
+                radarAlarmData.setRadarId(radarId);
+                radarAlarmData.setRadarName(radarName);
+                radarAlarmData.setAlarmTime(alarmTime);
+                radarAlarmData.setArdAlarmRadars(radarAlarmInfos);
+                MqttProducer.publish(2, false, "radar", JSON.toJSONString(radarAlarmData));
+                //鎶芥补鏈虹姸鎬丮QTT闃熷垪
+                radarAlarmData.setArdAlarmRadars(well);
+                MqttProducer.publish(2, false, "radarWellData", JSON.toJSONString(radarAlarmData));
             }
             if (Arrays.equals(cmdId, new byte[]{0x04})) {
                 //region鎶芥补鏈篈I鐘舵�佸弽棣�
@@ -355,16 +380,16 @@
                     byte[] fTx = Arrays.copyOfRange(data, index + 12, index + 16);
                     fTx = ByteUtils.toLittleEndian(fTx);
                     float fTxAngle = ByteUtils.bytesToFloat(fTx);
-                    //log.info("p瑙掑害:" + fTxAngle);
+                    log.debug("p瑙掑害:" + fTxAngle);
                     byte[] fTy = Arrays.copyOfRange(data, index + 16, index + 20);
                     fTy = ByteUtils.toLittleEndian(fTy);
                     float fTyAngle = ByteUtils.bytesToFloat(fTy);
-                    //log.info("t瑙掑害:" + fTyAngle);
+                    log.debug("t瑙掑害:" + fTyAngle);
 
                     byte[] sAreaNo = Arrays.copyOfRange(data, index + 20, index + 22);
                     sAreaNo = ByteUtils.toLittleEndian(sAreaNo);
                     int AreaNo = ByteUtils.bytesToDecimal(sAreaNo);
-                    //log.info("鐩爣褰掑睘鐨勫憡璀﹀尯鍩熷彿:" + AreaNo);
+                    log.debug("鐩爣褰掑睘鐨勫憡璀﹀尯鍩熷彿:" + AreaNo);
 
                     byte[] cGrp = Arrays.copyOfRange(data, index + 22, index + 23);
                     cGrp = ByteUtils.toLittleEndian(cGrp);
@@ -372,6 +397,8 @@
                     //log.info("鎵�灞炵粍:" + Grp);
                     //endregion
                     String alarmType;
+                    //鎶芥补鏈虹姸鎬佸彉閲�
+                    String wellType;
                     byte[] cStat = Arrays.copyOfRange(data, index + 23, index + 24);
                     cStat = ByteUtils.toLittleEndian(cStat);
                     //String binaryString = String.format("%8s", Integer.toBinaryString(cStat[0] & 0xFF)).replace(' ', '0');
@@ -382,39 +409,75 @@
                     // 鍒ゆ柇鎻愬彇鐨勫��
                     if (isB0) {
                         alarmType = "闆疯揪鎶芥补鏈哄仠鏈�";
+                        byte[] szName = Arrays.copyOfRange(data, index + 32, index + 64);
+                        //log.info("鎵�灞炲憡璀﹀尯鍩熷悕绉�:" + DatatypeConverter.printHexBinary(szName));
+                        String alarmPointName = ByteUtils.bytesToStringZh(szName);
+                        // log.info("鎵�灞炲憡璀﹀尯鍩熷悕绉�:" + alarmPointName);
+                        log.debug("鎶ヨ淇℃伅锛�" + "銆恑d銆�" + id + "銆恘ame銆�" + alarmPointName + "銆恆larmType銆�" + alarmType + "銆恆larmTime銆�" + alarmTime);
+                        ArdAlarmRadar ardAlarmRadar = new ArdAlarmRadar();
+                        ardAlarmRadar.setTargetId(id);
+                        ardAlarmRadar.setName(alarmPointName);
+                        ardAlarmRadar.setAlarmType(alarmType);
+                        radarAlarmInfos.add(ardAlarmRadar);
+                        wellType = "鍋滄満";
                     } else {
-                        continue;
+                        wellType = "杩愯";
                     }
-                    //log.info("鎶ヨ绫诲瀷:" + alarmType);
-
+                    //鎶芥补鏈虹姸鎬侀泦鍚堜腑瑁呭叆鏁版嵁
                     byte[] szName = Arrays.copyOfRange(data, index + 32, index + 64);
-                    //log.info("鎵�灞炲憡璀﹀尯鍩熷悕绉�:" + DatatypeConverter.printHexBinary(szName));
                     String alarmPointName = ByteUtils.bytesToStringZh(szName);
-                    // log.info("鎵�灞炲憡璀﹀尯鍩熷悕绉�:" + alarmPointName);
-                    //log.info("鎶ヨ淇℃伅锛�" + "銆恑d銆�" + id + "銆恘ame銆�" + alarmPointName + "銆恆larmType銆�" + alarmType + "銆恆larmTime銆�" + alarmTime);
-                    ArdAlarmRadar ardAlarmRadar = new ArdAlarmRadar();
-                    ardAlarmRadar.setTargetId(id);
-                    ardAlarmRadar.setName(alarmPointName);
-                    ardAlarmRadar.setAlarmType(alarmType);
-                    radarAlarmInfos.add(ardAlarmRadar);
+                    log.debug("鎶芥补鏈虹姸鎬佹姤璀︿俊鎭細" + "銆恑d銆�" + id + "銆恘ame銆�" + alarmPointName + "銆恆larmType銆�" + wellType + "銆恆larmTime銆�" + alarmTime);
+                    ArdAlarmRadar wellAlarm = new ArdAlarmRadar();
+                    wellAlarm.setTargetId(id);
+                    wellAlarm.setName(alarmPointName);
+                    wellAlarm.setAlarmType(wellType);
+                    well.add(wellAlarm);
                 }
                 //endregion
+                if (StringUtils.isEmpty(alarmTime)) {
+                    return;
+                }
+                if (targetNum == 0) {
+                    return;
+                }
+                RadarAlarmData radarAlarmData = new RadarAlarmData();
+                radarAlarmData.setRadarId(radarId);
+                radarAlarmData.setRadarName(radarName);
+                radarAlarmData.setAlarmTime(alarmTime);
+                radarAlarmData.setArdAlarmRadars(radarAlarmInfos);
+                MqttProducer.publish(2, false, "radar", JSON.toJSONString(radarAlarmData));
+                //鎶芥补鏈虹姸鎬丮QTT闃熷垪
+                radarAlarmData.setArdAlarmRadars(well);
+                MqttProducer.publish(2, false, "radarWellData", JSON.toJSONString(radarAlarmData));
             }
-            if (StringUtils.isEmpty(alarmTime)) {
-                return;
+            if (Arrays.equals(cmdId, new byte[]{0x02})) {
+                //region 鍛婅鍓嶇鍙戦�佺殑寮哄埗寮曞淇℃伅
+                byte[] iDistance = Arrays.copyOfRange(data, 4, 8);
+                iDistance = ByteUtils.toLittleEndian(iDistance);
+                long distance = ByteUtils.bytesToDecimal(iDistance);
+                log.info("鐩爣褰撳墠璺濈(m):" + distance);
+                byte[] fTx = Arrays.copyOfRange(data, 8, 12);
+                fTx = ByteUtils.toLittleEndian(fTx);
+                float tx = ByteUtils.bytesToFloat(fTx);
+                log.debug("鏂逛綅:" + tx);
+                byte[] fTy = Arrays.copyOfRange(data, 12, 16);
+                fTy = ByteUtils.toLittleEndian(fTy);
+                float ty = ByteUtils.bytesToFloat(fTy);
+                if (ty < 0) {
+                    ty += 360;
+                }
+                log.debug("淇话:" + ty);
+                Map<String, Object> forceGuideMap = new HashMap<>();
+                forceGuideMap.put("distance", distance);
+                forceGuideMap.put("p", tx);
+                forceGuideMap.put("t", ty);
+                forceGuideMap.put("radarId", radarId);
+                log.debug("寮哄埗寮曞淇℃伅" + forceGuideMap);
+                //endregion
+                MqttProducer.publish(2, false, "radarForceGuide", JSON.toJSONString(forceGuideMap));
             }
-            if (targetNum == 0) {
-                return;
-            }
-            RadarAlarmData radarAlarmData = new RadarAlarmData();
-            radarAlarmData.setRadarId(radarId);
-            radarAlarmData.setRadarName(radarName);
-            radarAlarmData.setAlarmTime(alarmTime);
-            radarAlarmData.setArdAlarmRadars(radarAlarmInfos);
-            MqttConsumer.publish(2, false, "radar", JSON.toJSONString(radarAlarmData));
         } catch (Exception ex) {
             log.error("闆疯揪鎶ユ枃瑙f瀽寮傚父:" + ex.getMessage());
         }
     }
-
-}
+}
\ No newline at end of file

--
Gitblit v1.9.3