| | |
| | | import com.ard.tianyu.model.dto.control.AbsAngleControlDTO; |
| | | import com.ard.tianyu.model.dto.control.AngleControlDTO; |
| | | import com.ard.tianyu.model.dto.control.SpeedControlDTO; |
| | | 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.converter.realdata.UavSignalInfoConverter; |
| | | import com.ard.tianyu.model.dto.converter.realdata.UavStateConverter; |
| | | import com.ard.tianyu.model.dto.converter.realdata.UavTelemetryDataConverter; |
| | | import com.ard.tianyu.model.dto.converter.wayline.PlanLineDataConverter; |
| | | import com.ard.tianyu.model.dto.manual.*; |
| | | import com.ard.tianyu.model.dto.settings.ReturnHeightSettingDTO; |
| | |
| | | import javax.annotation.Resource; |
| | | import java.net.InetSocketAddress; |
| | | import java.util.ArrayList; |
| | | import java.util.Collections; |
| | | import java.util.List; |
| | | import java.util.Map; |
| | | import java.util.concurrent.ConcurrentHashMap; |
| | | |
| | | /** |
| | | * TyServiceImpl |
| | |
| | | @Resource |
| | | private TyConfiguration tyConfiguration; |
| | | |
| | | // 存储每个无人机的最后遥测处理时间 |
| | | private Map<String, Long> lastTelemetryTimes = new ConcurrentHashMap<>(); |
| | | |
| | | /** |
| | | * 获取天宇token信息 |
| | |
| | | case (byte) 0xA8: |
| | | // 处理无人机状态消息 |
| | | UavStateCmd uavStateCmd = (UavStateCmd) tyCommand; |
| | | UavState uavState = UavStateConverter.convertProtoToEntity(uavStateCmd.getUavState()); |
| | | UavStateCache.putUavState(uavState); |
| | | logPrint("无人机状态", uavState.getBoxSn()); |
| | | WebSocketUtil.sendMessageAll(uavState); |
| | | UavStateCache.putUavState(uavStateCmd.getUavState()); |
| | | logPrint("无人机状态", uavStateCmd.getUavState().getBoxSn()); |
| | | WebSocketUtil.sendMessageAll(uavStateCmd.getUavState()); |
| | | break; |
| | | case (byte) 0xA9: |
| | | // 处理无人机遥测消息 |
| | | UavTelemetryDataCmd uavTelemetryDataCmd = (UavTelemetryDataCmd) tyCommand; |
| | | if (uavTelemetryDataCmd.getBoxSn() == null) { |
| | | return; |
| | | } |
| | | String boxSn = ByteUtils.bytesToString(uavTelemetryDataCmd.getBoxSn()); // 假设有获取无人机ID的方法 |
| | | long currentTime = System.currentTimeMillis(); |
| | | |
| | | // 获取无人机的最后处理时间,如果没有则设置为0 |
| | | long lastTelemetryTime = lastTelemetryTimes.getOrDefault(boxSn, 0L); |
| | | |
| | | // 检查与上次处理时间的间隔 |
| | | if (currentTime - lastTelemetryTime >= 1000) { // 1秒 |
| | | TelemetryData telemetryData = UavTelemetryDataConverter.convertProtoToEntity(uavTelemetryDataCmd.getTelemetryData()); |
| | | UavTelemetryDataCache.putUavTelemetryData(telemetryData); |
| | | logPrint("无人机遥测", telemetryData.getBoxSn()); |
| | | |
| | | // 更新最后处理时间 |
| | | lastTelemetryTimes.put(boxSn, currentTime); |
| | | } else { |
| | | log.debug("无人机 " + boxSn + " 遥测数据接收过于频繁,已跳过处理"); |
| | | } |
| | | UavTelemetryDataCache.putUavTelemetryData(uavTelemetryDataCmd.getTelemetryData()); |
| | | logPrint("无人机遥测", uavTelemetryDataCmd.getTelemetryData().getBoxSn()); |
| | | WebSocketUtil.sendMessageAll(uavTelemetryDataCmd.getTelemetryData()); |
| | | break; |
| | | |
| | | case (byte) 0x0C: |
| | | // 处理无人机信道质量数据 |
| | | SignalInfoCmd signalInfoCmd = (SignalInfoCmd) tyCommand; |
| | | SignalInfo signalInfo = UavSignalInfoConverter.convertProtoToEntity(signalInfoCmd.getSignalInfo()); |
| | | UavSignalInfoCache.putUavSignalInfoCache(signalInfo); |
| | | logPrint("无人机信道质量", signalInfo.getBoxSn()); |
| | | UavSignalInfoCache.putUavSignalInfoCache(signalInfoCmd.getSignalInfo()); |
| | | logPrint("无人机信道质量", signalInfoCmd.getSignalInfo().getBoxSn()); |
| | | break; |
| | | case (byte) 0xD1: |
| | | // 处理无人机 |