From 6c47588406827fa706e4068c692de3be0ae0188e Mon Sep 17 00:00:00 2001
From: ‘liusuyi’ <1951119284@qq.com>
Date: 星期一, 04 十二月 2023 11:04:26 +0800
Subject: [PATCH] 雷达引导追踪优化
---
ard-work/src/main/java/com/ruoyi/alarm/radar/service/impl/ArdRadarServiceImpl.java | 73 ++++++++++++++++++++++++++++++++----
1 files changed, 65 insertions(+), 8 deletions(-)
diff --git a/ard-work/src/main/java/com/ruoyi/alarm/radar/service/impl/ArdRadarServiceImpl.java b/ard-work/src/main/java/com/ruoyi/alarm/radar/service/impl/ArdRadarServiceImpl.java
index 8abcf5c..9539b06 100644
--- a/ard-work/src/main/java/com/ruoyi/alarm/radar/service/impl/ArdRadarServiceImpl.java
+++ b/ard-work/src/main/java/com/ruoyi/alarm/radar/service/impl/ArdRadarServiceImpl.java
@@ -1,18 +1,24 @@
package com.ruoyi.alarm.radar.service.impl;
import com.alibaba.fastjson2.JSONObject;
+import com.ruoyi.alarm.radar.domain.ArdAlarmRadar;
+import com.ruoyi.alarm.radar.domain.RadarAlarmData;
import com.ruoyi.alarm.radar.service.ArdRadarService;
import com.ruoyi.common.utils.StringUtils;
+import com.ruoyi.device.camera.domain.ArdCameras;
import com.ruoyi.device.camera.domain.CameraCmd;
import com.ruoyi.device.camera.service.ICameraSdkService;
import com.ruoyi.device.radar.mapper.ArdEquipRadarMapper;
import com.ruoyi.storage.minio.domain.jsonbean.JsonsRootBean;
+import com.ruoyi.utils.gis.GisUtil;
import lombok.extern.slf4j.Slf4j;
+import org.gavaghan.geodesy.GlobalCoordinates;
import org.springframework.scheduling.annotation.Async;
import org.springframework.stereotype.Service;
import javax.annotation.Resource;
import java.util.HashMap;
+import java.util.List;
import java.util.Map;
/**
@@ -42,19 +48,26 @@
if (msgMap != null) {
Double p = Double.parseDouble(msgMap.get("p").toString());
Double t = Double.parseDouble(msgMap.get("t").toString());
- Double z = Double.parseDouble(msgMap.get("z").toString());
+ Long distance = Long.parseLong(msgMap.get("distance").toString());
String radarId = msgMap.get("radarId").toString();
//鑾峰彇闆疯揪鎵�鍦ㄥ涓婄殑澶у厜鐢�
- String cameraIdWithTower = ardEquipRadarMapper.getCameraByRadar(radarId);
- if (StringUtils.isNotNull(cameraIdWithTower) && StringUtils.isNotEmpty(cameraIdWithTower)) {
- log.debug("鑾峰彇鍒伴浄杈惧涓婄殑鍏夌數:" + cameraIdWithTower);
+ ArdCameras camera = ardEquipRadarMapper.getCameraByRadar(radarId);
+ if (StringUtils.isNotNull(camera)) {
+ log.debug("鑾峰彇鍒伴浄杈惧涓婄殑鍏夌數:" + camera.getId());
+ //璁＄畻鐩爣鐐瑰潗鏍�
+ GlobalCoordinates cameraCoordinates = new GlobalCoordinates(camera.getLatitude(), camera.getLongitude());
+ GlobalCoordinates targetCoordinates = GisUtil.getGlobalCoordinates(cameraCoordinates, p, distance);
+ //鑾峰彇ptz
+ double[] cameraPoint = new double[]{ camera.getLongitude(), camera.getLatitude(),camera.getAltitude()};
+ double[] targetPoint = new double[]{targetCoordinates.getLongitude(), targetCoordinates.getLatitude()};
+ double[] cameraPTZ = GisUtil.getCameraPTZ(cameraPoint, targetPoint, 20, 150);
//濡傛灉闆疯揪濉斾笂鏈夊厜鐢�
- CameraCmd cmd = new CameraCmd(cameraIdWithTower, 1);
+ CameraCmd cmd = new CameraCmd(camera.getId(), 1);
cmd.setOperator("sys_radar_force");
Map<String, Double> ptzMap = new HashMap<>();
ptzMap.put("p", p);
ptzMap.put("t", t);
- ptzMap.put("z", z);
+ ptzMap.put("z", cameraPTZ[2]);
cmd.setPtzMap(ptzMap);
boolean res = iCameraSdkService.setPtz(cmd);
if (res) {
@@ -67,7 +80,51 @@
}
}
} catch (Exception ex) {
- log.error("寮哄埗寮曞寮傚父:"+ ex.getMessage());
+ log.error("寮哄埗寮曞寮傚父:" + ex.getMessage());
}
}
-}
+ /**
+ * 寮傛闆疯揪杩借釜寮曞
+ * 鍒樿嫃涔�
+ * 2023/11/2 9:00:55
+ */
+ @Override
+ @Async
+ public void followGuide(String msg) {
+ try {
+ RadarAlarmData radarFollowData = JSONObject.parseObject(msg, RadarAlarmData.class);
+ if (radarFollowData != null) {
+ List<ArdAlarmRadar> ardFollowRadars = radarFollowData.getArdFollowRadars();
+ if (ardFollowRadars.size()>0) {
+ //褰撴瘡娆′笂鎶ュ彧涓婃姤涓�涓拷韪俊鎭紝璁や负涓嶅お鍙兘闆疯揪鎵弿涓�娆′細璺熻釜澶氫釜鐩爣
+ ardFollowRadars.get(0)
+ String radarId = radarFollowData.getRadarId();//闆疯揪id
+ //杩欓噷杩借釜鐨勫潗鏍囦负闆疯揪缁忚繃璁＄畻涓婁紶鐨勭粡绾害
+ Double longitude = ardFollowRadar.getLongitude();
+ Double latitude = ardFollowRadar.getLatitude();
+ //鑾峰彇闆疯揪鎵�鍦ㄥ涓婄殑澶у厜鐢�
+ ArdCameras camera = ardEquipRadarMapper.getCameraByRadar(radarId);
+ if (StringUtils.isNotNull(camera)) {
+ log.debug("鑾峰彇鍒伴浄杈惧涓婄殑澶у厜鐢�:" + camera.getId());
+ //濡傛灉闆疯揪濉斾笂鏈夊厜鐢�,寮曞鍏夌數鐨�1閫氶亾鍒拌拷韪殑鍧愭爣
+ CameraCmd cmd = new CameraCmd(camera.getId(), 1);
+ cmd.setOperator("sys_radar_follow");
+ cmd.setCameraId(camera.getId());
+ cmd.setChanNo(1);
+ cmd.setTargetPosition(new double[]{longitude,latitude});
+ boolean res = iCameraSdkService.guideTargetPosition(cmd);
+ if (res) {
+ log.debug("闆疯揪杩借釜寮曞鎴愬姛");
+ } else {
+ log.debug("闆疯揪杩借釜寮曞澶辫触");
+ }
+ } else {
+ log.debug("鏈幏鍙栧埌闆疯揪濉斾笂鐨勫ぇ鍏夌數");
+ }
+ }
+ }
+ } catch (Exception ex) {
+ log.error("闆疯揪杩借釜寮曞寮傚父:" + ex.getMessage());
+ }
+ }
+}
\ No newline at end of file
--
Gitblit v1.9.3