¶Ô±ÈÐÂÎļþ |
| | |
| | | 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.mqtt.MqttProducer; |
| | | import com.ard.utils.other.ByteUtils; |
| | | import com.ard.utils.other.GisUtils; |
| | | import io.netty.buffer.ByteBuf; |
| | | import io.netty.channel.Channel; |
| | | import io.netty.channel.ChannelHandlerContext; |
| | | import io.netty.channel.SimpleChannelInboundHandler; |
| | | import lombok.extern.slf4j.Slf4j; |
| | | import org.apache.commons.lang3.StringUtils; |
| | | import javax.xml.bind.DatatypeConverter; |
| | | import java.text.SimpleDateFormat; |
| | | import java.util.*; |
| | | import java.util.concurrent.ScheduledFuture; |
| | | import java.util.concurrent.TimeUnit; |
| | | import static com.ard.utils.other.ByteUtils.byteToBitString; |
| | | import static com.ard.utils.other.ByteUtils.toLittleEndian; |
| | | |
| | | /** |
| | | * @Description: 客æ·ç«¯æ°æ®å¤çå¨ï¼å¤ç¨ï¼ |
| | | * @ClassName: DynamicClientHandler |
| | | * @Author: åèä¹ |
| | | * @Date: 2023å¹´11æ30æ¥9:27:55 |
| | | **/ |
| | | @Slf4j(topic = "netty") |
| | | class DynamicClientHandler extends SimpleChannelInboundHandler<ByteBuf> { |
| | | /** |
| | | * è¿æ¥å»ºç« |
| | | * |
| | | * @param ctx |
| | | * @throws Exception |
| | | */ |
| | | @Override |
| | | public void channelActive(ChannelHandlerContext ctx) { |
| | | context = ctx; |
| | | startHeartbeatTask();//å¼å§åéå¿è·³ |
| | | } |
| | | |
| | | @Override |
| | | protected void channelRead0(ChannelHandlerContext ctx, ByteBuf msg) { |
| | | // å¤çæ¥æ¶å°çæ°æ® |
| | | // ... |
| | | Channel channel = ctx.channel(); |
| | | ArdEquipRadar ardEquipRadar = DynamicClient.ConnectMap.get(channel); |
| | | // å¤çæ¥æ¶å°çæ¶æ¯ |
| | | byte[] byteArray = new byte[msg.readableBytes()]; |
| | | msg.getBytes(msg.readerIndex(), byteArray); |
| | | byte[] bytes = MessageParsing.receiveCompletePacket(byteArray); |
| | | if (bytes != null) { |
| | | processData(ardEquipRadar, bytes); |
| | | } |
| | | } |
| | | |
| | | @Override |
| | | public void exceptionCaught(ChannelHandlerContext ctx, Throwable cause) throws Exception { |
| | | // å¤çå¼å¸¸ |
| | | // ... |
| | | log.error("å¤çå¼å¸¸"); |
| | | } |
| | | |
| | | private ScheduledFuture<?> heartbeatTask; |
| | | private ChannelHandlerContext context; |
| | | |
| | | /** |
| | | * å¼å§å¿è·³ä»»å¡ |
| | | */ |
| | | private void startHeartbeatTask() { |
| | | heartbeatTask = context.executor().scheduleAtFixedRate(() -> { |
| | | // åéå¿è·³æ¶æ¯ |
| | | ByteBuf message = context.alloc().buffer(); |
| | | byte[] header = {0x01, 0x02, 0x01}; |
| | | byte[] payload = {0x10, 0x00, 0x00, 0x00}; |
| | | byte[] payloadCrc32 = ByteUtils.parseCrc32(payload); |
| | | byte[] footer = {0x01, 0x02, 0x00}; |
| | | 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); |
| | | message.writeBytes(heart); |
| | | context.writeAndFlush(message); |
| | | |
| | | }, 0, 5, TimeUnit.SECONDS); |
| | | } |
| | | |
| | | /** |
| | | * 忢å¿è·³ä»»å¡ |
| | | */ |
| | | private void stopHeartbeatTask() { |
| | | if (heartbeatTask != null) { |
| | | heartbeatTask.cancel(false); |
| | | heartbeatTask = null; |
| | | } |
| | | } |
| | | |
| | | /** |
| | | * è§£ææ¥è¦æ°æ® |
| | | */ |
| | | public void processData(ArdEquipRadar ardEquipRadarbyte, byte[] data) { |
| | | try { |
| | | String radarId = ardEquipRadarbyte.getId(); |
| | | 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æ ¡éªéè¿"); |
| | | } |
| | | //endregion |
| | | //log.info("åå§æ°æ®:" + DatatypeConverter.printHexBinary(data)); |
| | | //log.info("é·è¾¾ä¿¡æ¯ï¼" + host + "ãportã" + port + "ãXã" + longitude + "ãYã" + lagitude + "ãZã" + altitude); |
| | | data = MessageParsing.transferData(data);//廿å
头åå
å°¾ãæ ¡éªåè½¬ä¹ |
| | | //region è´è½½å¤´è§£æ |
| | | byte[] type = Arrays.copyOfRange(data, 0, 1);//å½ä»¤ç±»å |
| | | // log.info("å½ä»¤ç±»å:" + DatatypeConverter.printHexBinary(type)); |
| | | byte[] cmdId = Arrays.copyOfRange(data, 1, 2);//å½ä»¤ID |
| | | String cmdIdStr = DatatypeConverter.printHexBinary(cmdId); |
| | | //log.info("å½ä»¤ID:" + DatatypeConverter.printHexBinary(cmdId)); |
| | | byte[] payloadSize = Arrays.copyOfRange(data, 2, 4);//ææè´è½½å¤§å° |
| | | payloadSize = toLittleEndian(payloadSize); |
| | | //log.info("payloadSize:" + DatatypeConverter.printHexBinary(payloadSize)); |
| | | int payloadSizeToDecimal = ByteUtils.bytesToDecimal(payloadSize); |
| | | // log.info("ææè´è½½å¤§å°(转æ´å):" + payloadSizeToDecimal); |
| | | //endregion |
| | | List<ArdAlarmRadar> radarAlarmInfos = new ArrayList<>(); |
| | | ArdAlarmRadar radarFollowInfo = null; |
| | | //æ½æ²¹æºç¶æé·è¾¾æ¨ééå |
| | | List<ArdAlarmRadar> well = new ArrayList<>(); |
| | | String alarmTime = ""; |
| | | Integer targetNum = 0; |
| | | log.debug("Processing radar data ã" + radarName + "ãæ°æ®-->å½ä»¤ID:" + cmdIdStr + "äºè¿å¶:" + byteToBitString(cmdId[0])); |
| | | //é·è¾¾ç§»å¨é²ç«æ¥è¦ |
| | | if (Arrays.equals(cmdId, new byte[]{0x01})) { |
| | | //region åè¦ä¿¡æ¯åé¦ |
| | | byte[] dwTim = Arrays.copyOfRange(data, 4, 8); |
| | | dwTim = toLittleEndian(dwTim); |
| | | SimpleDateFormat sdf = new SimpleDateFormat("yyyy-MM-dd HH:mm:ss"); |
| | | long l = ByteUtils.bytesToDecimal(dwTim); |
| | | alarmTime = sdf.format(l * 1000); |
| | | // log.info("å¨è§å¾åçåºç°æ¶é´(转date):" + alarmTime); |
| | | |
| | | byte[] wTargetNum = Arrays.copyOfRange(data, 8, 10); |
| | | wTargetNum = toLittleEndian(wTargetNum); |
| | | targetNum = ByteUtils.bytesToDecimal(wTargetNum); |
| | | if (targetNum == 0) { |
| | | return; |
| | | } |
| | | //log.debug("ç®æ æ»ç¹æ°(转æ´å):" + targetNum); |
| | | |
| | | //è§£æNET_TARGET_UNIT(64æ¯NET_TARGET_HEADçåèæ°) |
| | | int uintSize = (payloadSizeToDecimal - 64) / targetNum; |
| | | // log.info("åæ¡æ¥è¦å¤§å°:" + uintSize); |
| | | |
| | | for (int i = 0; i < targetNum; i++) { |
| | | |
| | | Integer index = 68 + uintSize * i; |
| | | byte[] dwID = Arrays.copyOfRange(data, index, index + 4); |
| | | // log.info("ç®æ ID:" + DatatypeConverter.printHexBinary(cmdId)); |
| | | dwID = toLittleEndian(dwID); |
| | | int targetId = ByteUtils.bytesToDecimal(dwID); |
| | | // log.info("ç®æ IDå·ï¼" + targetId); |
| | | |
| | | byte[] iDistance = Arrays.copyOfRange(data, index + 8, index + 12); |
| | | iDistance = toLittleEndian(iDistance); |
| | | double Distance = ByteUtils.bytesToDecimal(iDistance); |
| | | //log.debug("ç®æ å½åç´çº¿è·ç¦»(m):" + Distance); |
| | | |
| | | //region ä¸éè¦çåæ®µ |
| | | // byte[] dwGSum = Arrays.copyOfRange(data, index + 4, index + 8); |
| | | // dwGSum = toLittleEndian(dwGSum); |
| | | // int GSum = byteArrayToDecimal(dwGSum); |
| | | // log.info("ç®æ å½ååç´ ç°åº¦åï¼" + GSum); |
| | | // byte[] iTw = Arrays.copyOfRange(data, index + 12, index + 16); |
| | | // iTw = toLittleEndian(iTw); |
| | | // int Tw = byteArrayToDecimal(iTw); |
| | | // log.info("ç®æ å½åçåç´ å®½åº¦:" + Tw); |
| | | // |
| | | // byte[] iTh = Arrays.copyOfRange(data, index + 16, index + 20); |
| | | // iTh = toLittleEndian(iTh); |
| | | // int Th = byteArrayToDecimal(iTh); |
| | | // log.info("ç®æ å½åçåç´ é«åº¦:" + Th); |
| | | // |
| | | // byte[] wPxlArea = Arrays.copyOfRange(data, index + 20, index + 22); |
| | | // wPxlArea = toLittleEndian(wPxlArea); |
| | | // int PxlArea = byteArrayToDecimal(wPxlArea); |
| | | // log.info("ç®æ å½ååç´ é¢ç§¯:" + PxlArea); |
| | | // |
| | | // byte[] cTrkNum = Arrays.copyOfRange(data, index + 22, index + 23); |
| | | // cTrkNum = toLittleEndian(cTrkNum); |
| | | // int TrkNum = byteArrayToDecimal(cTrkNum); |
| | | // log.info("è½¨è¿¹ç¹æ°:" + TrkNum); |
| | | |
| | | // byte[] sVx = Arrays.copyOfRange(data, index + 24, index + 26); |
| | | // sVx = toLittleEndian(sVx); |
| | | // int Vx = byteArrayToDecimal(sVx); |
| | | // log.info("ç®æ å½åé度ç¢é(åç´ è·ç¦»)X:" + Vx); |
| | | // |
| | | // byte[] sVy = Arrays.copyOfRange(data, index + 26, index + 28); |
| | | // sVy = toLittleEndian(sVy); |
| | | // int Vy = byteArrayToDecimal(sVy); |
| | | // log.info("ç®æ å½åé度ç¢é(åç´ è·ç¦»)Y:" + Vy); |
| | | // |
| | | // byte[] sAreaNo = Arrays.copyOfRange(data, index + 28, index + 30); |
| | | // sAreaNo = toLittleEndian(sAreaNo); |
| | | // int AreaNo = byteArrayToDecimal(sAreaNo); |
| | | // log.info("ç®æ å½å±çåè¦åºåå·:" + AreaNo); |
| | | // |
| | | // byte[] cGrp = Arrays.copyOfRange(data, index + 30, index + 31); |
| | | // cGrp = toLittleEndian(cGrp); |
| | | // int Grp = byteArrayToDecimal(cGrp); |
| | | // log.info("æå±ç»:" + Grp); |
| | | //endregion |
| | | String alarmType = ""; |
| | | byte[] cStat = Arrays.copyOfRange(data, index + 23, index + 24); |
| | | log.info("åå§ç¶æ:" + byteToBitString(cStat[0])); |
| | | // cStat = toLittleEndian(cStat); |
| | | // æå第4ä½è³ç¬¬6ä½çå¼ |
| | | int extractedValue = (cStat[0] >> 4) & 0b00001111; |
| | | // 夿æåçå¼ |
| | | if (extractedValue == 0b0000) { |
| | | alarmType = "è¿å¨ç®æ æ£æµ"; |
| | | } else if (extractedValue == 0b0001) { |
| | | alarmType = "çæºæ£æµ"; |
| | | } |
| | | // log.info("æ¥è¦ç±»å:" + alarmType); |
| | | byte[] szName = Arrays.copyOfRange(data, index + 64, index + 96); |
| | | String alarmPointName = ByteUtils.bytesToStringZh(szName); |
| | | // log.info("æå±åè¦åºååç§°:" + alarmPointName); |
| | | byte[] afTx = Arrays.copyOfRange(data, index + 96, index + 100); |
| | | afTx = toLittleEndian(afTx); |
| | | float fTx = ByteUtils.bytesToFloat(afTx); |
| | | // log.info("æ°´å¹³è§åº¦:" + fTx); |
| | | byte[] afTy = Arrays.copyOfRange(data, index + 112, index + 116); |
| | | afTy = toLittleEndian(afTy); |
| | | float fTy = ByteUtils.bytesToFloat(afTy); |
| | | //log.debug("åç´è§åº¦:" + fTy); |
| | | // å°è§åº¦è½¬æ¢ä¸ºå¼§åº¦ |
| | | double thetaRadians = Math.toRadians(fTy + 90); |
| | | // ä½¿ç¨æ£å¼¦å½æ°è®¡ç®å¯¹è¾¹é¿åº¦ |
| | | Distance = Math.sin(thetaRadians) * Distance; |
| | | //log.debug("ç®æ æå½±è·ç¦»(m):" + Distance); |
| | | |
| | | Double[] radarXY = {radarLongitude, radarLagitude}; |
| | | Double[] alarmXY = GisUtils.CalculateCoordinates(radarXY, Distance, (double) fTx); |
| | | log.debug("æ¥è¦ä¿¡æ¯ï¼" + "ãradarNameã" + radarName + "ãtargetIdã" + targetId + "ãalarmTypeã" + alarmType + "ãalarmTimeã" + alarmTime + "ãnameã" + alarmPointName); |
| | | ArdAlarmRadar ardAlarmRadar = new ArdAlarmRadar(); |
| | | ardAlarmRadar.setTargetId(targetId); |
| | | ardAlarmRadar.setName(alarmPointName); |
| | | ardAlarmRadar.setLongitude(alarmXY[0]); |
| | | ardAlarmRadar.setLatitude(alarmXY[1]); |
| | | ardAlarmRadar.setAlarmType(alarmType); |
| | | radarAlarmInfos.add(ardAlarmRadar); |
| | | |
| | | int bit1 = (cStat[0] >> 1) & 0x1; |
| | | //ç®æ çB1=1 éå® |
| | | if (bit1 == 1) { |
| | | radarFollowInfo = ardAlarmRadar; |
| | | //å°è¿½è¸ªéå®çæ¥è¦å¯¹è±¡å±æ§å¤å¶ç»radarFollowInfo对象 |
| | | //BeanUtils.copyProperties(ardAlarmRadar, radarFollowInfo); |
| | | } |
| | | } |
| | | //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)); |
| | | if (radarFollowInfo != null) { |
| | | //å½åé·è¾¾æ«æåå¨å¼å¯¼è·è¸ªæ°æ®ï¼åªä¿çæå䏿¬¡éå®çæ°æ® |
| | | MqttProducer.publish(2, false, "radarFollowGuide", JSON.toJSONString(radarFollowInfo)); |
| | | } |
| | | //æ½æ²¹æºç¶æMQTTéå |
| | | radarAlarmData.setArdAlarmRadars(well); |
| | | MqttProducer.publish(2, false, "radarWellData", JSON.toJSONString(radarAlarmData)); |
| | | |
| | | } |
| | | //æ½æ²¹æºAIç¶æåé¦ |
| | | if (Arrays.equals(cmdId, new byte[]{0x04})) { |
| | | //regionæ½æ²¹æºAIç¶æåé¦ |
| | | String hexString = DatatypeConverter.printHexBinary(data); |
| | | //log.info(hexString); |
| | | |
| | | byte[] dwTim = Arrays.copyOfRange(data, 4, 8); |
| | | dwTim = toLittleEndian(dwTim); |
| | | SimpleDateFormat sdf = new SimpleDateFormat("yyyy-MM-dd HH:mm:ss"); |
| | | long l = ByteUtils.bytesToDecimal(dwTim); |
| | | alarmTime = sdf.format(l * 1000); |
| | | //log.info("å¨è§å¾åçåºç°æ¶é´(转date):" + alarmTime); |
| | | |
| | | byte[] wTargetNum = Arrays.copyOfRange(data, 8, 10); |
| | | wTargetNum = toLittleEndian(wTargetNum); |
| | | targetNum = ByteUtils.bytesToDecimal(wTargetNum); |
| | | //log.debug("ç®æ æ»ç¹æ°(转æ´å):" + targetNum); |
| | | if (targetNum == 0) { |
| | | return; |
| | | } |
| | | //è§£æNET_TARGET_UNIT(64æ¯NET_TARGET_HEADçåèæ°) |
| | | int uintSize = (payloadSizeToDecimal - 64) / targetNum; |
| | | //log.info("åæ¡æ¥è¦å¤§å°:" + uintSize); |
| | | for (int i = 0; i < targetNum; i++) { |
| | | Integer index = 68 + uintSize * i; |
| | | byte[] dwID = Arrays.copyOfRange(data, index, index + 4); |
| | | //log.info("ç®æ ID:" + DatatypeConverter.printHexBinary(dwID)); |
| | | dwID = toLittleEndian(dwID); |
| | | int targetId = ByteUtils.bytesToDecimal(dwID); |
| | | //log.info("ç®æ IDå·ï¼" + targetId); |
| | | //region ä¸éè¦çåæ®µ |
| | | byte[] iTw = Arrays.copyOfRange(data, index + 4, index + 8); |
| | | iTw = toLittleEndian(iTw); |
| | | int Tw = ByteUtils.bytesToDecimal(iTw); |
| | | // log.info("ç®æ å½åçåç´ å®½åº¦:" + Tw); |
| | | |
| | | byte[] iTh = Arrays.copyOfRange(data, index + 8, index + 12); |
| | | iTh = toLittleEndian(iTh); |
| | | int Th = ByteUtils.bytesToDecimal(iTh); |
| | | //log.info("ç®æ å½åçåç´ é«åº¦:" + Th); |
| | | |
| | | byte[] fTx = Arrays.copyOfRange(data, index + 12, index + 16); |
| | | fTx = toLittleEndian(fTx); |
| | | float fTxAngle = ByteUtils.bytesToFloat(fTx); |
| | | //log.debug("pè§åº¦:" + fTxAngle); |
| | | byte[] fTy = Arrays.copyOfRange(data, index + 16, index + 20); |
| | | fTy = toLittleEndian(fTy); |
| | | float fTyAngle = ByteUtils.bytesToFloat(fTy); |
| | | //log.debug("tè§åº¦:" + fTyAngle); |
| | | |
| | | byte[] sAreaNo = Arrays.copyOfRange(data, index + 20, index + 22); |
| | | sAreaNo = toLittleEndian(sAreaNo); |
| | | int AreaNo = ByteUtils.bytesToDecimal(sAreaNo); |
| | | //log.debug("ç®æ å½å±çåè¦åºåå·:" + AreaNo); |
| | | |
| | | byte[] cGrp = Arrays.copyOfRange(data, index + 22, index + 23); |
| | | cGrp = toLittleEndian(cGrp); |
| | | int Grp = ByteUtils.bytesToDecimal(cGrp); |
| | | //log.info("æå±ç»:" + Grp); |
| | | //endregion |
| | | String alarmType; |
| | | //æ½æ²¹æºç¶æåé |
| | | String wellType; |
| | | byte[] cStat = Arrays.copyOfRange(data, index + 23, index + 24); |
| | | cStat = toLittleEndian(cStat); |
| | | //String binaryString = String.format("%8s", Integer.toBinaryString(cStat[0] & 0xFF)).replace(' ', '0'); |
| | | //log.info("ç®æ å½åç¶æ:" + binaryString); |
| | | // æå第0ä½å¼ |
| | | // 使ç¨ä½è¿ç®æä½å¤æç¬¬0使¯å¦ä¸º1 |
| | | boolean isB0 = (cStat[0] & 0x01) == 0x00; |
| | | // 夿æåçå¼ |
| | | 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("æ¥è¦ä¿¡æ¯ï¼"+ "ãradarNameã" + radarName + "ãtargetIdã" + targetId + "ãnameã" + alarmPointName + "ãalarmTypeã" + alarmType + "ãalarmTimeã" + alarmTime); |
| | | ArdAlarmRadar ardAlarmRadar = new ArdAlarmRadar(); |
| | | ardAlarmRadar.setTargetId(targetId); |
| | | ardAlarmRadar.setName(alarmPointName); |
| | | ardAlarmRadar.setAlarmType(alarmType); |
| | | radarAlarmInfos.add(ardAlarmRadar); |
| | | wellType = "åæº"; |
| | | } else { |
| | | wellType = "è¿è¡"; |
| | | } |
| | | //æ½æ²¹æºç¶æéåä¸è£
å
¥æ°æ® |
| | | byte[] szName = Arrays.copyOfRange(data, index + 32, index + 64); |
| | | String alarmPointName = ByteUtils.bytesToStringZh(szName); |
| | | log.debug("æ¥è¦ä¿¡æ¯ï¼" + "ãradarNameã" + radarName + "ãtargetIdã" + targetId + "ãalarmTypeãæ½æ²¹æºç¶ææ¥è¦" + "ãalarmTimeã" + alarmTime + "ãnameã" + alarmPointName + "ãalarmStateã" + wellType); |
| | | ArdAlarmRadar wellAlarm = new ArdAlarmRadar(); |
| | | wellAlarm.setTargetId(targetId); |
| | | 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)); |
| | | //æ½æ²¹æºç¶æMQTTéå |
| | | radarAlarmData.setArdAlarmRadars(well); |
| | | MqttProducer.publish(2, false, "radarWellData", JSON.toJSONString(radarAlarmData)); |
| | | } |
| | | //强å¶å¼å¯¼ |
| | | if (Arrays.equals(cmdId, new byte[]{0x02})) { |
| | | //region åè¦å端åéç强å¶å¼å¯¼ä¿¡æ¯ |
| | | byte[] iDistance = Arrays.copyOfRange(data, 4, 8); |
| | | iDistance = toLittleEndian(iDistance); |
| | | long distance = ByteUtils.bytesToDecimal(iDistance); |
| | | log.info("ç®æ å½åè·ç¦»(m):" + distance); |
| | | byte[] fTx = Arrays.copyOfRange(data, 8, 12); |
| | | fTx = toLittleEndian(fTx); |
| | | float tx = ByteUtils.bytesToFloat(fTx); |
| | | log.debug("æ¹ä½:" + tx); |
| | | byte[] fTy = Arrays.copyOfRange(data, 12, 16); |
| | | fTy = 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)); |
| | | } |
| | | } catch (Exception ex) { |
| | | log.error("é·è¾¾æ¥æè§£æå¼å¸¸:" + ex.getMessage()); |
| | | } |
| | | } |
| | | } |