From 125de0818505c4ff40495f55c6c4d27f6e79846f Mon Sep 17 00:00:00 2001
From: aix <vip_xiaobin810@163.com>
Date: Tue, 09 Jul 2024 11:36:20 +0800
Subject: [PATCH] 航线生成飞行器偏移

---
 src/main/java/com/dji/sample/patches/xml/mode/XMLTemplateModel.java |   16 +++++++++++++---
 1 files changed, 13 insertions(+), 3 deletions(-)

diff --git a/src/main/java/com/dji/sample/patches/xml/mode/XMLTemplateModel.java b/src/main/java/com/dji/sample/patches/xml/mode/XMLTemplateModel.java
index d9a075a..6f2b986 100644
--- a/src/main/java/com/dji/sample/patches/xml/mode/XMLTemplateModel.java
+++ b/src/main/java/com/dji/sample/patches/xml/mode/XMLTemplateModel.java
@@ -69,6 +69,8 @@
                 actionGroup.setActionTrigger(at);
                 // 开始增加事件
                 List<ActionMode> list = new ArrayList<>();
+
+                //拍照事件
                 ActionMode actionMode = new ActionMode();
                 actionMode.setActionId(1);
                 actionMode.setActionActuatorFunc(CameraActionEnum.TAKE_PHOTO.getDescription());//拍照事件
@@ -78,15 +80,23 @@
                 actionMode.setActionActuatorFuncParam(ActionUtils.setTakePhoto(lotInfos.get(pointPO.getIndex()).getDkbh() + "~" + lotInfos.get(pointPO.getIndex()).getTaskId()));
 //                actionMode.setActionActuatorFuncParam(ActionUtils.setTakePhoto("测试"));
 
+                //云台旋转事件
                 ActionMode actionMode2 = new ActionMode();
                 actionMode2.setActionId(0);
                 actionMode2.setActionActuatorFunc(CameraActionEnum.GIMBAL_ROTATE.getDescription());//旋转云台
-
                 //设置转动角度
-                double bearing = GeoToolsUtil.bearing(pointPO.getCoordinate().x,pointPO.getCoordinate().y,pointPO.getCentro().x,pointPO.getCentro().y);
+                double bearing = GeoToolsUtil.bearing(pointPO.getCoordinate().y,pointPO.getCoordinate().x,pointPO.getCentro().y,pointPO.getCentro().x);
+//                System.out.println("角度:" + bearing);
                 actionMode2.setActionActuatorFuncParam(ActionUtils.setGimbalRotate(bearing));
 
-                list.add(actionMode2);//添加云台旋转
+                // 飞行器偏航事件
+                ActionMode actionModeFxqph = new ActionMode();
+                actionModeFxqph.setActionId(0);
+                actionModeFxqph.setActionActuatorFunc(CameraActionEnum.ROTATE_YAW.getDescription());//飞行器偏航
+                actionModeFxqph.setActionActuatorFuncParam(ActionUtils.setRotateYaw(bearing));
+
+//                list.add(actionMode2);//添加云台旋转
+                list.add(actionModeFxqph);//添加飞行器偏航
                 list.add(actionMode);//添加拍照
                 actionGroup.setActions(list);
 

--
Gitblit v1.9.3