| | |
| | | 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 UavRouteReq initialization(UavRouteReq uavRouteReq){ |
| | | uavRouteReq.setTemplateType("waypoint"); |
| | | // 起始点默认航线第一个点 |
| | | if (uavRouteReq.getTakeOffRefPoint().isEmpty()){ |
| | | if (uavRouteReq.getTakeOffRefPoint() == null){ |
| | | uavRouteReq.setTakeOffRefPoint( |
| | | uavRouteReq.getRoutePointList().get(0).getLatitude() + "," + |
| | | uavRouteReq.getRoutePointList().get(0).getLongitude() + "," + "0"); |
| | |
| | | } |
| | | uavRouteReq.setWaypointTurnReq(waypointTurnReq); |
| | | uavRouteReq.setGimbalPitchMode("usePointSetting"); |
| | | // 变焦数值加工 |
| | | buildZoom(uavRouteReq); |
| | | uavRouteReq.setHeightMode("EGM96"); |
| | | 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(multiple_23(action.getZoom())); |
| | | //action.setZoom(multiple_6(action.getZoom())); |
| | | if (!routePointReq.getActionGroupList().isEmpty()){ |
| | | for (ActionGroupReq actionGroupReq : routePointReq.getActionGroupList()) { |
| | | for (PointActionReq action : actionGroupReq.getActions()) { |
| | | if (action.getZoom() != null){ |
| | | action.setZoom(multiple_23(action.getZoom())); |
| | | } |
| | | } |
| | | } |
| | | } |
| | |
| | | return zoom * CHANSI_H20T; |
| | | } |
| | | |
| | | public static Double multiple_6(Double zoom){ |
| | | return zoom * CHANSI_H20_FOCUS; |
| | | } |
| | | |
| | | public static Double divided_23(Double zoom){ |
| | | return zoom / CHANSI_H20T; |
| | | } |
| | | |
| | | public static Double divided_6(Double zoom){ |
| | | return zoom / CHANSI_H20_FOCUS; |
| | | } |
| | | |
| | | /** |
| | |
| | | // ardRoutePoints1.setLon(103.75851462); |
| | | // ardRoutePoints1.setSafeGohomeFlag(0); |
| | | // ardRoutePoints1.setSpeed(8); |
| | | // |
| | | // |
| | | // } |
| | | |
| | | // private ArdRouteActions buildArdRouteActions(){ |