| | |
| | | import java.util.ArrayList; |
| | | import java.util.List; |
| | | |
| | | import static com.ard.route.enums.kml.DroneEnumValueEnums.M350_RTK; |
| | | import static com.ard.route.util.ToolUtils.getDoublePoint; |
| | | |
| | | /** |
| | |
| | | public class InitializationUtils { |
| | | |
| | | // 禅思H20T 公倍数 |
| | | private static final Double CHANSI_H20 = 23.76237623; |
| | | private static final Double CHANSI_H20T = 23.76237623; |
| | | |
| | | // 禅思H20T 焦距值 |
| | | private static final Double CHANSI_H20_FOCUS = 6.83; |
| | |
| | | } |
| | | uavRouteReq.setWaypointTurnReq(waypointTurnReq); |
| | | uavRouteReq.setGimbalPitchMode("usePointSetting"); |
| | | // 变焦数值加工 |
| | | buildZoom(uavRouteReq); |
| | | if (M350_RTK.getValue().equals(uavRouteReq.getDroneType())) { |
| | | // 变焦数值加工 |
| | | buildZoom(uavRouteReq); |
| | | } |
| | | // 修改每个航点的高度 |
| | | buildHeight(uavRouteReq); |
| | | // 动作组编号数据加工 |
| | |
| | | */ |
| | | private void buildZoom(UavRouteReq uavRouteReq){ |
| | | for (RoutePointReq routePointReq : uavRouteReq.getRoutePointList()) { |
| | | for (ActionGroupReq actionGroupReq : routePointReq.getActionGroupList()) { |
| | | for (PointActionReq action : actionGroupReq.getActions()) { |
| | | if (action.getZoom() != null){ |
| | | //action.setZoom(action.getZoom() * CHANSI_H20); |
| | | action.setZoom(action.getZoom() * CHANSI_H20_FOCUS); |
| | | if (!routePointReq.getActionGroupList().isEmpty()){ |
| | | for (ActionGroupReq actionGroupReq : routePointReq.getActionGroupList()) { |
| | | for (PointActionReq action : actionGroupReq.getActions()) { |
| | | if (action.getZoom() != null){ |
| | | action.setZoom(multiple_23(action.getZoom())); |
| | | } |
| | | } |
| | | } |
| | | } |
| | | } |
| | | } |
| | | |
| | | public static Double multiple_23(Double zoom){ |
| | | return zoom * CHANSI_H20T; |
| | | } |
| | | |
| | | public static Double divided_23(Double zoom){ |
| | | return zoom / CHANSI_H20T; |
| | | } |
| | | |
| | | /** |
| | |
| | | // ardRoutePoints1.setLon(103.75851462); |
| | | // ardRoutePoints1.setSafeGohomeFlag(0); |
| | | // ardRoutePoints1.setSpeed(8); |
| | | // |
| | | // |
| | | // } |
| | | |
| | | // private ArdRouteActions buildArdRouteActions(){ |