forked from uav/ard-uav-server
ard-work/src/main/java/com/ard/tianyu/service/impl/TyServiceImpl.java
@@ -1,5 +1,6 @@ package com.ard.tianyu.service.impl; import com.ard.common.utils.ByteUtils; import com.ard.tianyu.config.TyConfiguration; import com.ard.tianyu.http.TyClient; import com.ard.tianyu.model.cache.UavSignalInfoCache; @@ -8,30 +9,37 @@ 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.camera.CameraModeDTO; import com.ard.tianyu.model.dto.camera.CapturePicDTO; import com.ard.tianyu.model.dto.camera.RecordDTO; import com.ard.tianyu.model.dto.camera.*; 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.manual.*; import com.ard.tianyu.model.dto.signal.SignalInfo; import com.ard.tianyu.model.dto.speaker.*; 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; import com.ard.tianyu.netty.command.camera.*; import com.ard.tianyu.netty.command.control.AbsAngleControlCommand; import com.ard.tianyu.netty.command.control.AngleControlCommand; import com.ard.tianyu.netty.command.control.SpeedControlCommand; import com.ard.tianyu.netty.command.real.SignalInfoCommand; import com.ard.tianyu.netty.command.real.UavStateCommand; import com.ard.tianyu.netty.command.real.UavTelemetryDataCommand; import com.ard.tianyu.netty.command.control.AbsAngleControlCmd; import com.ard.tianyu.netty.command.control.AngleControlCmd; import com.ard.tianyu.netty.command.control.SpeedControlCmd; import com.ard.tianyu.netty.command.manual.*; import com.ard.tianyu.netty.command.notice.BoxPowerStatusReplyCmd; import com.ard.tianyu.netty.command.notice.FlyWayEndReplyCmd; import com.ard.tianyu.netty.command.notice.UavReadyReplyCmd; import com.ard.tianyu.netty.command.real.SignalInfoCmd; import com.ard.tianyu.netty.command.real.UavStateCmd; import com.ard.tianyu.netty.command.real.UavTelemetryDataCmd; import com.ard.tianyu.netty.command.register.*; import com.ard.tianyu.netty.command.speaker.*; import com.ard.tianyu.netty.handler.ErrorCodeEnum; import com.ard.tianyu.service.ITyService; import com.ard.tianyu.websocket.utils.WebSocketUtil; import io.netty.channel.Channel; import io.netty.channel.ChannelFuture; import lombok.extern.slf4j.Slf4j; @@ -42,6 +50,8 @@ import java.net.InetSocketAddress; import java.util.ArrayList; import java.util.List; import java.util.Map; import java.util.concurrent.ConcurrentHashMap; /** * TyServiceImpl @@ -58,6 +68,9 @@ @Resource private TyConfiguration tyConfiguration; // 存储每个无人机的最后遥测处理时间 private Map<String, Long> lastTelemetryTimes = new ConcurrentHashMap<>(); /** * 获取天宇token信息 @@ -134,30 +147,12 @@ */ @Override public void registerMessage() { AccessTokenReceiver tyToken = tyConfiguration.getAccessToken(); RegisterCommand registerMessage = new RegisterCommand(tyToken.getCompanyId(), tyToken.getAccessToken().getBytes()); this.sendMessage(tyConfiguration.getIpPort(), registerMessage); } /** * 发送消息 */ public void sendMessage(String key, BaseCommand msg) { try { ChannelFuture future = TyNettyTcpClient.channels.get(key).getChannelFuture(); Channel channel = future.channel(); if (channel.isActive()) { InetSocketAddress ipSocket = (InetSocketAddress) channel.remoteAddress(); String host = ipSocket.getHostString(); int port = ipSocket.getPort(); channel.writeAndFlush(msg); // 发送编码后的数据 log.debug("向天宇服务器【{}:{}】发送数据，命令码：{}", host, port, String.format("0x%02X", msg.getCmdCode() & 0xFF)); } else { log.error("与天宇服务器链接断开，无法发送数据！"); } AccessTokenReceiver tyToken = tyConfiguration.getAccessToken(); RegisterCmd registerMessage = new RegisterCmd(tyToken.getCompanyId(), tyToken.getAccessToken().getBytes()); this.sendMessage(tyConfiguration.getIpPort(), registerMessage); } catch (Exception e) { log.error("发送消息异常：{}", e.getMessage()); log.error("注册天宇平台失败:{}", e.getMessage()); } } @@ -166,7 +161,7 @@ */ @Override public void angleControl(AngleControlDTO angleControlDto) { AngleControlCommand controlAngleCommand = new AngleControlCommand(angleControlDto); AngleControlCmd controlAngleCommand = new AngleControlCmd(angleControlDto); this.sendMessage(tyConfiguration.getIpPort(), controlAngleCommand); } @@ -175,7 +170,7 @@ */ @Override public void absAngleControl(AbsAngleControlDTO absAngleControlDto) { AbsAngleControlCommand absAngleControlCommand = new AbsAngleControlCommand(absAngleControlDto); AbsAngleControlCmd absAngleControlCommand = new AbsAngleControlCmd(absAngleControlDto); this.sendMessage(tyConfiguration.getIpPort(), absAngleControlCommand); } @@ -184,7 +179,7 @@ */ @Override public void speedControl(SpeedControlDTO speedControlDto) { SpeedControlCommand speedControlCommand = new SpeedControlCommand(speedControlDto); SpeedControlCmd speedControlCommand = new SpeedControlCmd(speedControlDto); this.sendMessage(tyConfiguration.getIpPort(), speedControlCommand); } @@ -193,7 +188,7 @@ */ @Override public void updateCameraMode(CameraModeDTO cameraModeDTO) { CameraModeCommand cameraModeCommand = new CameraModeCommand(cameraModeDTO); CameraModeCmd cameraModeCommand = new CameraModeCmd(cameraModeDTO); this.sendMessage(tyConfiguration.getIpPort(), cameraModeCommand); } @@ -202,8 +197,8 @@ */ @Override public void capturePic(CapturePicDTO capturePicDto) { updateCameraMode(CameraModeDTO.builder().boxSn(capturePicDto.getBoxSn()).actionParam((byte)0x01).build()); CapturePicCommand capturePicCommand = new CapturePicCommand(capturePicDto); updateCameraMode(CameraModeDTO.builder().boxSn(capturePicDto.getBoxSn()).actionParam((byte) 0x01).build()); CapturePicCmd capturePicCommand = new CapturePicCmd(capturePicDto); this.sendMessage(tyConfiguration.getIpPort(), capturePicCommand); } @@ -212,14 +207,158 @@ */ @Override public void record(RecordDTO recordDto) { BaseCommand baseCommand; BaseCmd baseCmd; if (recordDto.getIsRecord()) { updateCameraMode(CameraModeDTO.builder().boxSn(recordDto.getBoxSn()).actionParam((byte)0x02).build()); baseCommand = new RecordStartCommand(recordDto); updateCameraMode(CameraModeDTO.builder().boxSn(recordDto.getBoxSn()).actionParam((byte) 0x02).build()); baseCmd = new RecordStartCmd(recordDto); } else { baseCommand = new RecordStopCommand(recordDto); baseCmd = new RecordStopCmd(recordDto); } this.sendMessage(tyConfiguration.getIpPort(), baseCommand); this.sendMessage(tyConfiguration.getIpPort(), baseCmd); } /** * 变倍 */ @Override public void zoom(ZoomDTO zoomDTO) { ZoomCmd zoomCommand = new ZoomCmd(zoomDTO); this.sendMessage(tyConfiguration.getIpPort(), zoomCommand); } /** * 变倍到指定倍数 */ @Override public void zoomToLevel(ZoomToLevelDTO zoomToLevelDTO) { ZoomToLevelCmd zoomToLevelCommand = new ZoomToLevelCmd(zoomToLevelDTO); this.sendMessage(tyConfiguration.getIpPort(), zoomToLevelCommand); } /** * 切换摄像头 */ @Override public void switchCamera(SwitchCameraDTO switchCameraDTO) { SwitchCameraCmd switchCameraCmd = new SwitchCameraCmd(switchCameraDTO); this.sendMessage(tyConfiguration.getIpPort(), switchCameraCmd); } /** * 切换视频源 */ @Override public void switchSource(SwitchSourceDTO switchSourceDTO) { SwitchSourceCmd switchSourceCmd = new SwitchSourceCmd(switchSourceDTO); this.sendMessage(tyConfiguration.getIpPort(), switchSourceCmd); } /** * 打开或关闭照片回传 */ @Override public void photoReturnToggle(PhotoReturnToggleDTO photoReturnToggleDTO) { PhotoReturnToggleCmd photoReturnToggleCmd = new PhotoReturnToggleCmd(photoReturnToggleDTO); this.sendMessage(tyConfiguration.getIpPort(), photoReturnToggleCmd); } /** * 切换无人机控制权 */ @Override public void switchUavControl(SwitchUavControlDTO switchUavControlDTO) { SwitchUavControlCmd switchUavControlCmd = new SwitchUavControlCmd(switchUavControlDTO); this.sendMessage(tyConfiguration.getIpPort(), switchUavControlCmd); } /** * 起飞 */ @Override public void takeOff(TakeOffDTO takeOffDTO) { TakeOffCmd takeOffCmd = new TakeOffCmd(takeOffDTO); this.sendMessage(tyConfiguration.getIpPort(), takeOffCmd); } /** * 返航 */ @Override public void returnHome(ReturnHomeDTO returnHomeDTO) { ReturnHomeCmd returnHomeCmd = new ReturnHomeCmd(returnHomeDTO); this.sendMessage(tyConfiguration.getIpPort(), returnHomeCmd); } /** * 取消返航 */ @Override public void returnHomeCancel(ReturnHomeCancelDTO returnHomeCancelDTO) { ReturnHomeCancelCmd returnHomeCancelCmd = new ReturnHomeCancelCmd(returnHomeCancelDTO); this.sendMessage(tyConfiguration.getIpPort(), returnHomeCancelCmd); } /** * 降落 */ @Override public void land(LandDTO landDTO) { LandCmd landCmd = new LandCmd(landDTO); this.sendMessage(tyConfiguration.getIpPort(), landCmd); } /** * 取消降落 */ @Override public void landCancel(LandCancelDTO landCancelDTO) { LandCancelCmd landCancelCmd = new LandCancelCmd(landCancelDTO); this.sendMessage(tyConfiguration.getIpPort(), landCancelCmd); } /** * 强制降落 */ @Override public void landForced(LandForcedDTO landForcedDTO) { LandForcedCmd landForcedCmd = new LandForcedCmd(landForcedDTO); this.sendMessage(tyConfiguration.getIpPort(), landForcedCmd); } /** * 方向控制 */ @Override public void flyControl(FlyControlDTO flyControlDTO) { FlyControlCmd flyControlCmd = new FlyControlCmd(flyControlDTO); this.sendMessage(tyConfiguration.getIpPort(), flyControlCmd); } /** * 指点飞行控制 */ @Override public void flyPointControl(FlyPointControlDTO flyPointControlDTO) { FlyPointControlCmd flyPointControlCmd = new FlyPointControlCmd(flyPointControlDTO); this.sendMessage(tyConfiguration.getIpPort(), flyPointControlCmd); } /** * 停止指点飞行控制 */ @Override public void flyPointControlCancel(FlyPointControlCancelDTO flyPointControlCancelDTO) { FlyPointControlCancelCmd flyPointControlCancelCmd = new FlyPointControlCancelCmd(flyPointControlCancelDTO); this.sendMessage(tyConfiguration.getIpPort(), flyPointControlCancelCmd); } /** * 紧急制动 */ @Override public void emeragencyBrake(EmeragencyBrakeDTO emeragencyBrakeDTO) { EmergencyBrakeCmd emergencyBrakeCmd = new EmergencyBrakeCmd(emeragencyBrakeDTO); this.sendMessage(tyConfiguration.getIpPort(), emergencyBrakeCmd); } /** @@ -246,14 +385,78 @@ return UavSignalInfoCache.getUavSignalInfo(boxSn); } /** * 喊话模式切换 */ @Override public void processMessage(String key, BaseCommand tyCommand) { public void speakModeSwitch(SpeakModeSwitchDTO speakModeSwitchDTO) { SpeakModeSwitchCmd speakModeSwitchCmd = new SpeakModeSwitchCmd(speakModeSwitchDTO); this.sendMessage(tyConfiguration.getIpPort(), speakModeSwitchCmd); } /** * 文字喊话 */ @Override public void textSpeak(TextSpeakDTO textSpeakDTO) { TextSpeakCmd textSpeakCmd = new TextSpeakCmd(textSpeakDTO); this.sendMessage(tyConfiguration.getIpPort(), textSpeakCmd); } /** * 实时喊话 */ @Override public void realSpeak(RealSpeakDTO realSpeakDTO) { RealSpeakCmd realSpeakCmd = new RealSpeakCmd(realSpeakDTO); this.sendMessage(tyConfiguration.getIpPort(), realSpeakCmd); } /** * 录音喊话 */ @Override public void recordSpeak(RecordSpeakDTO recordSpeakDTO) { RecordSpeakCmd recordSpeakCmd = new RecordSpeakCmd(recordSpeakDTO); this.sendMessage(tyConfiguration.getIpPort(), recordSpeakCmd); } /** * 设置音量 */ @Override public void volumeSetting(VolumeSettingDTO volumeSettingDTO) { VolumeSettingCmd volumeSettingCmd = new VolumeSettingCmd(volumeSettingDTO); this.sendMessage(tyConfiguration.getIpPort(), volumeSettingCmd); } /** * 设置循环播放 */ @Override public void loopSetting(LoopSettingDTO loopSettingDTO) { LoopSettingCmd loopSettingCmd = new LoopSettingCmd(loopSettingDTO); this.sendMessage(tyConfiguration.getIpPort(), loopSettingCmd); } /** * 停止喊话 */ @Override public void stopSpeak(StopSpeakDTO stopSpeakDTO) { StopSpeakCmd stopSpeakCmd=new StopSpeakCmd(stopSpeakDTO); this.sendMessage(tyConfiguration.getIpPort(), stopSpeakCmd); } /** * 处理天宇服务器返回的消息 */ @Override public void processReplyMessage(String key, BaseCmd tyCommand) { byte cmdCode = tyCommand.getCmdCode(); switch (cmdCode) { case 0x01: // 处理心跳消息 RegisterReplyCommand registerReplyCommand = (RegisterReplyCommand) tyCommand; log.info("收到注册消息-->处理注册消息{}", registerReplyCommand.getSuccess()); RegisterReplyCmd registerReplyCommand = (RegisterReplyCmd) tyCommand; logPrint("注册消息", registerReplyCommand.getSuccess()); if (registerReplyCommand.getSuccess() != 1) { // 注册失败，重新注册 log.info("注册失败，重新注册"); @@ -262,8 +465,8 @@ break; case 0x02: // 处理注册消息 HeartbeatReplyCommand heartbeatReplyCommand = (HeartbeatReplyCommand) tyCommand; log.debug("收到心跳消息-->处理心跳消息{}", heartbeatReplyCommand.getTimestamp()); HeartbeatReplyCmd heartbeatReplyCmd = (HeartbeatReplyCmd) tyCommand; logPrint("心跳消息", heartbeatReplyCmd.getTimestamp()); break; case 0x03: // 处理订阅消息 @@ -271,75 +474,173 @@ case 0x04: // 处理取消订阅消息 break; case 0x0A: // 处理云盒开关机通知消息 BoxPowerStatusReplyCmd boxPowerStatusReplyCmd = (BoxPowerStatusReplyCmd) tyCommand; logPrint("云盒开关机通知消息", boxPowerStatusReplyCmd.getStatus()); break; case (byte) 0xA8: // 处理无人机状态消息 log.debug("收到无人机状态消息-->无人机状态消息"); UavStateCommand uavStateCommand = (UavStateCommand) tyCommand; UavState uavState = UavStateConverter.convertProtoToEntity(uavStateCommand.getUavState()); UavStateCmd uavStateCmd = (UavStateCmd) tyCommand; UavState uavState = UavStateConverter.convertProtoToEntity(uavStateCmd.getUavState()); UavStateCache.putUavState(uavState); logPrint("无人机状态", uavState.getBoxSn()); WebSocketUtil.sendMessageAll(uavState); break; case (byte) 0xA9: // 处理无人机遥测消息 log.debug("收到无人机遥测消息-->无人机遥测消息"); UavTelemetryDataCommand uavTelemetryDataCommand = (UavTelemetryDataCommand) tyCommand; TelemetryData telemetryData = UavTelemetryDataConverter.convertProtoToEntity(uavTelemetryDataCommand.getTelemetryData()); UavTelemetryDataCache.putUavTelemetryData(telemetryData); 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 + " 遥测数据接收过于频繁，已跳过处理"); } break; case (byte) 0x0C: // 处理无人机信道质量数据 log.debug("收到无人机信道质量数据消息-->无人机信道质量数据消息"); SignalInfoCommand signalInfoCommand = (SignalInfoCommand) tyCommand; SignalInfo signalInfo = UavSignalInfoConverter.convertProtoToEntity(signalInfoCommand.getSignalInfo()); SignalInfoCmd signalInfoCmd = (SignalInfoCmd) tyCommand; SignalInfo signalInfo = UavSignalInfoConverter.convertProtoToEntity(signalInfoCmd.getSignalInfo()); UavSignalInfoCache.putUavSignalInfoCache(signalInfo); logPrint("无人机信道质量", signalInfo.getBoxSn()); break; case (byte) 0xD1: // 处理无人机 if (tyCommand instanceof UavReadyNotificationCommand) { UavReadyNotificationCommand droneReadyNotificationCommand = (UavReadyNotificationCommand) tyCommand; if (droneReadyNotificationCommand.getActionCode() == (byte) 0x42) { UavInitInfoCommand uavInitCommand = new UavInitInfoCommand(droneReadyNotificationCommand.getBoxSn()); this.sendMessage(tyConfiguration.getIpPort(), uavInitCommand); log.info("收到无人机初始化详情-回复防止再次发送"); } if (tyCommand instanceof UavInitReplyCmd) { UavInitReplyCmd uavInitReplyCmd = (UavInitReplyCmd) tyCommand; UavInitInfoCmd uavInitCommand = new UavInitInfoCmd(uavInitReplyCmd.getBoxSn()); this.sendMessage(tyConfiguration.getIpPort(), uavInitCommand); logPrint("无人机初始化详情", uavInitCommand.getBoxSn()); } if (tyCommand instanceof CameraModeReplyCommand) { CameraModeReplyCommand cameraModeReplyCommand = (CameraModeReplyCommand) tyCommand; if (cameraModeReplyCommand.getActionCode() == (byte) 0x22) { log.info("收到无人机设置相机模式回复:{} 错误码：{}", String.format("0x%02X", cameraModeReplyCommand.getResult() & 0xFF), cameraModeReplyCommand.getErrorCode()); } if (tyCommand instanceof UavReadyReplyCmd) { UavReadyReplyCmd uavReadyReplyCmd = (UavReadyReplyCmd) tyCommand; logPrint("无人机准备完成通知", uavReadyReplyCmd.getBatteryPower()); } if (tyCommand instanceof CapturePicReplyCommand) { CapturePicReplyCommand capturePicReplyCommand = (CapturePicReplyCommand) tyCommand; if (capturePicReplyCommand.getActionCode() == (byte) 0x23) { log.info("收到无人机拍照回复:{} 错误码：{}", String.format("0x%02X", capturePicReplyCommand.getResult() & 0xFF), capturePicReplyCommand.getErrorCode()); } if (tyCommand instanceof CameraModeReplyCmd) { CameraModeReplyCmd cameraModeReplyCommand = (CameraModeReplyCmd) tyCommand; logPrint("无人机设置相机模式", cameraModeReplyCommand.getResult(), cameraModeReplyCommand.getErrorCode()); } if (tyCommand instanceof RecordStartReplyCommand) { RecordStartReplyCommand recordStartReplyCommand = (RecordStartReplyCommand) tyCommand; if (recordStartReplyCommand.getActionCode() == (byte) 0x24) { log.info("收到无人机开始录像回复:{} 错误码：{}", String.format("0x%02X", recordStartReplyCommand.getResult() & 0xFF), recordStartReplyCommand.getErrorCode()); } if (tyCommand instanceof FlyWayEndReplyCmd) { FlyWayEndReplyCmd flyWayEndReplyCmd = (FlyWayEndReplyCmd) tyCommand; logPrint("无人机飞行结束", flyWayEndReplyCmd.getResult(), flyWayEndReplyCmd.getErrorCode()); } if (tyCommand instanceof RecordStopReplyCommand) { RecordStopReplyCommand recordStopReplyCommand = (RecordStopReplyCommand) tyCommand; if (recordStopReplyCommand.getActionCode() == (byte) 0x25) { log.info("收到无人机停止录像回复:{} 错误码：{}", String.format("0x%02X", recordStopReplyCommand.getResult() & 0xFF), recordStopReplyCommand.getErrorCode()); } if (tyCommand instanceof CapturePicReplyCmd) { CapturePicReplyCmd capturePicReplyCommand = (CapturePicReplyCmd) tyCommand; logPrint("无人机拍照", capturePicReplyCommand.getResult(), capturePicReplyCommand.getErrorCode()); } if (tyCommand instanceof RecordStartReplyCmd) { RecordStartReplyCmd recordStartReplyCommand = (RecordStartReplyCmd) tyCommand; logPrint("无人机开始录像", recordStartReplyCommand.getResult(), recordStartReplyCommand.getErrorCode()); } if (tyCommand instanceof RecordStopReplyCmd) { RecordStopReplyCmd recordStopReplyCommand = (RecordStopReplyCmd) tyCommand; logPrint("无人机停止录像", recordStopReplyCommand.getResult(), recordStopReplyCommand.getErrorCode()); } //起飞回复 if (tyCommand instanceof TakeOffReplyCmd) { TakeOffReplyCmd takeOffReplyCommand = (TakeOffReplyCmd) tyCommand; logPrint("无人机起飞", takeOffReplyCommand.getResult(), takeOffReplyCommand.getErrorCode()); } //返航回复 if (tyCommand instanceof ReturnHomeReplyCmd) { ReturnHomeReplyCmd returnHomeReplyCmd = (ReturnHomeReplyCmd) tyCommand; logPrint("无人机返航", returnHomeReplyCmd.getResult(), returnHomeReplyCmd.getErrorCode()); } //取消返航回复 if (tyCommand instanceof ReturnHomeCancelReplyCmd) { ReturnHomeCancelReplyCmd returnHomeCancelReplyCmd = (ReturnHomeCancelReplyCmd) tyCommand; logPrint("取消无人机返航", returnHomeCancelReplyCmd.getResult(), returnHomeCancelReplyCmd.getErrorCode()); } //降落回复 if (tyCommand instanceof LandReplyCmd) { LandReplyCmd landReplyCmd = (LandReplyCmd) tyCommand; logPrint("降落", landReplyCmd.getResult(), landReplyCmd.getErrorCode()); } //取消降落回复 if (tyCommand instanceof LandCancelReplyCmd) { LandCancelReplyCmd landCancelReplyCmd = (LandCancelReplyCmd) tyCommand; logPrint("取消降落", landCancelReplyCmd.getResult(), landCancelReplyCmd.getErrorCode()); } //强制降落回复 if (tyCommand instanceof LandForcedReplyCmd) { LandForcedReplyCmd landForcedReplyCmd = (LandForcedReplyCmd) tyCommand; logPrint("强制降落", landForcedReplyCmd.getResult(), landForcedReplyCmd.getErrorCode()); } //到达指点飞行位置回复 if (tyCommand instanceof PointControlReachedReplyCmd) { PointControlReachedReplyCmd pointControlReachedReplyCmd = (PointControlReachedReplyCmd) tyCommand; logPrint("到达指点飞行位置", pointControlReachedReplyCmd.getResult(), pointControlReachedReplyCmd.getErrorCode()); } //紧急制动回复 if (tyCommand instanceof EmergencyBrakeReplyCmd) { EmergencyBrakeReplyCmd emergencyBrakeReplyCmd = (EmergencyBrakeReplyCmd) tyCommand; logPrint("紧急制动回复", emergencyBrakeReplyCmd.getResult(), emergencyBrakeReplyCmd.getErrorCode()); } break; default: // 处理其他消息 log.debug("收到其他消息-->其他消息"); log.warn("收到其他消息-->{}", tyCommand.getCmdCode()); } } //公共日志打印 private void logPrint(String message, Object obj) { log.debug("收到{}回复{}", message, obj); } //公共日志打印 private void logPrint(String message, byte result, Integer errorCode) { log.info("收到{}回复:{} 错误码：{}【{}】", message, ByteUtils.byteToHex(result), errorCode, ErrorCodeEnum.getDescByCode(errorCode)); } /** * 定时3秒发送心跳指令 */ @Scheduled(fixedRate = 3000) public void sendHeartBeat() { long timestamp = System.currentTimeMillis(); log.debug("定时向天宇发送⼼跳,时间戳{}", timestamp); HeartbeatCommand heartbeatMessage = new HeartbeatCommand(timestamp); HeartbeatCmd heartbeatMessage = new HeartbeatCmd(timestamp); this.sendMessage(tyConfiguration.getIpPort(), heartbeatMessage); } /** * 发送消息 */ private void sendMessage(String key, BaseCmd msg) { try { ChannelFuture future = TyNettyTcpClient.channels.get(key).getChannelFuture(); Channel channel = future.channel(); if (channel.isActive()) { InetSocketAddress ipSocket = (InetSocketAddress) channel.remoteAddress(); String host = ipSocket.getHostString(); int port = ipSocket.getPort(); channel.writeAndFlush(msg); // 发送编码后的数据 log.debug("向天宇服务器【{}:{}】发送数据，命令码：{}", host, port, String.format("0x%02X", msg.getCmdCode() & 0xFF)); } else { log.error("与天宇服务器链接断开，无法发送数据！"); } } catch (Exception e) { log.error("发送消息异常：{}", e.getMessage()); } } }
