From e9ad2e18fcff1e6adcf4dd624a8ec02f9cb6c13e Mon Sep 17 00:00:00 2001
From: liusuyi <1951119284@qq.com>
Date: Thu, 24 Oct 2024 17:24:39 +0800
Subject: [PATCH] 增加protobuf映射实体解析数据
---
ard-work/src/main/java/com/ard/tianyu/service/impl/TyServiceImpl.java | 68 +++++++++++++++++++++++++++++++---
1 files changed, 62 insertions(+), 6 deletions(-)
diff --git a/ard-work/src/main/java/com/ard/tianyu/service/impl/TyServiceImpl.java b/ard-work/src/main/java/com/ard/tianyu/service/impl/TyServiceImpl.java
index 9ec76ae..e51eee5 100644
--- a/ard-work/src/main/java/com/ard/tianyu/service/impl/TyServiceImpl.java
+++ b/ard-work/src/main/java/com/ard/tianyu/service/impl/TyServiceImpl.java
@@ -2,9 +2,18 @@
import com.ard.tianyu.config.TyConfiguration;
import com.ard.tianyu.http.TyClient;
+import com.ard.tianyu.model.cache.UavSignalInfoCache;
+import com.ard.tianyu.model.cache.UavStateCache;
+import com.ard.tianyu.model.cache.UavTelemetryDataCache;
import com.ard.tianyu.model.dto.BoxHistoryDTO;
import com.ard.tianyu.model.dto.BoxPhotosDTO;
import com.ard.tianyu.model.dto.BoxSettingsDTO;
+import com.ard.tianyu.model.dto.converter.UavSignalInfoConverter;
+import com.ard.tianyu.model.dto.converter.UavStateConverter;
+import com.ard.tianyu.model.dto.converter.UavTelemetryDataConverter;
+import com.ard.tianyu.model.dto.signal.SignalInfo;
+import com.ard.tianyu.model.dto.state.UavState;
+import com.ard.tianyu.model.dto.telemetry.TelemetryData;
import com.ard.tianyu.model.receiver.*;
import com.ard.tianyu.netty.command.*;
import com.ard.tianyu.netty.TyNettyTcpClient;
@@ -154,9 +163,33 @@
* 云台控制基于角度
*/
@Override
- public void controlAngle(String boxSn) {
- ControlAngleCommand controlAngleCommand = new ControlAngleCommand(boxSn.getBytes(), (byte) 0x00, (byte) 0x00, (byte) 0x05);
+ public void controlAngle(String boxSn, Integer actionId, Integer rotationAngle) {
+ ControlAngleCommand controlAngleCommand = new ControlAngleCommand(boxSn.getBytes(), (byte) 0x00, actionId.byteValue(), rotationAngle.byteValue());
this.sendMessage(tyConfiguration.getIpPort(), controlAngleCommand);
+ }
+
+ /**
+ * 获取无人机状态
+ */
+ @Override
+ public UavState getUavState(String boxSn) {
+ return UavStateCache.getUavState(boxSn);
+ }
+
+ /**
+ * 获取无人机遥测数据
+ */
+ @Override
+ public TelemetryData getUavTelemetryData(String boxSn) {
+ return UavTelemetryDataCache.getUavTelemetryData(boxSn);
+ }
+
+ /**
+ * 获取无人机遥测数据
+ */
+ @Override
+ public SignalInfo getSignalInfo(String boxSn) {
+ return UavSignalInfoCache.getUavSignalInfo(boxSn);
}
@Override
@@ -176,7 +209,7 @@
case 0x02:
// 处理注册消息
HeartbeatReplyCommand heartbeatReplyCommand = (HeartbeatReplyCommand) tyCommand;
- log.info("收到心跳消息-->处理心跳消息{}", heartbeatReplyCommand.getTimestamp());
+ log.debug("收到心跳消息-->处理心跳消息{}", heartbeatReplyCommand.getTimestamp());
break;
case 0x03:
// 处理订阅消息
@@ -190,18 +223,41 @@
break;
case (byte) 0xA8:
// 处理无人机状态消息
- log.info("收到无人机状态消息-->无人机状态消息");
+ log.debug("收到无人机状态消息-->无人机状态消息");
+ UavStateCommand uavStateCommand = (UavStateCommand) tyCommand;
+ UavState uavState = UavStateConverter.convertProtoToEntity(uavStateCommand.getUavState());
+ UavStateCache.putUavState(uavState);
break;
case (byte) 0xA9:
// 处理无人机遥测消息
- log.info("收到无人机遥测消息-->无人机遥测消息");
+ log.debug("收到无人机遥测消息-->无人机遥测消息");
+ UavTelemetryDataCommand uavTelemetryDataCommand = (UavTelemetryDataCommand) tyCommand;
+ TelemetryData telemetryData = UavTelemetryDataConverter.convertProtoToEntity(uavTelemetryDataCommand.getTelemetryData());
+ UavTelemetryDataCache.putUavTelemetryData(telemetryData);
+ break;
+ case (byte) 0x0C:
+ // 处理无人机信道质量数据
+ log.debug("收到无人机信道质量数据消息-->无人机信道质量数据消息");
+ SignalInfoCommand signalInfoCommand = (SignalInfoCommand) tyCommand;
+ SignalInfo signalInfo = UavSignalInfoConverter.convertProtoToEntity(signalInfoCommand.getSignalInfo());
+ UavSignalInfoCache.putUavSignalInfoCache(signalInfo);
+ break;
+ case (byte) 0xD1:
+ // 处理无人机
+ DroneReadyNotificationCommand droneReadyNotificationCommand = (DroneReadyNotificationCommand) tyCommand;
+ if (droneReadyNotificationCommand.getActionCode() == (byte) 0x42) {
+ UavInitInfoCommand uavInitCommand = new UavInitInfoCommand((byte) 0x00, (byte) 0x42, (byte) 0x01);
+ this.sendMessage(tyConfiguration.getIpPort(), uavInitCommand);
+ log.info("收到无人机初始化详情-回复防止再次发送");
+ }
break;
default:
// 处理其他消息
+ log.debug("收到其他消息-->其他消息");
}
}
- @Scheduled(fixedRate = 5000)
+ @Scheduled(fixedRate = 3000)
public void sendHeartBeat() {
long timestamp = System.currentTimeMillis();
log.debug("定时向天宇发送⼼跳,时间戳{}", timestamp);
--
Gitblit v1.9.3