ChargerTask

servo/src/main/java/com/galaxis/rcs/plan/path/PtrPathPlanner.java

@@ -2,10 +2,7 @@ package com.galaxis.rcs.plan.path;
 
 import com.galaxis.rcs.common.enums.LCCDirection;
 import com.galaxis.rcs.plan.PlanTaskSequence;
-import com.galaxis.rcs.plan.task.CarryTask;
+import com.galaxis.rcs.plan.task.*;
-import com.galaxis.rcs.plan.task.LoadTask;
-import com.galaxis.rcs.plan.task.MoveTask;
-import com.galaxis.rcs.plan.task.UnloadTask;
 
 import java.util.List;
 
@@ -20,6 +17,9 @@ public class PtrPathPlanner {
         this.astar = new AStarPathPlanner(graph);
     }
 
+    public void planChargerTask(PlanTaskSequence planSequence, String id, LCCDirection fromDirection, ChargerTask chargerTask) {
+
+    }
 
     public void planMoveTask(PlanTaskSequence plan, String startNodeId, LCCDirection startDirection, MoveTask moveTask) {
 

servo/src/main/java/com/galaxis/rcs/plan/task/ChargerTask.java

@@ -0,0 +1,9 @@
+package com.galaxis.rcs.plan.task;
+
+import com.galaxis.rcs.common.enums.LCCDirection;
+
+public record ChargerTask(
+    String agv,
+    String targetWayPointId,
+    LCCDirection targetDirection) {
+}

servo/src/main/java/com/yvan/workbench/controller/RcsController.java

@@ -12,6 +12,7 @@ import com.yvan.workbench.model.entity.Model;
 import org.apache.commons.lang3.NotImplementedException;
 import org.clever.core.Conv;
 import org.clever.core.id.SnowFlake;
+import org.clever.core.model.response.R;
 import org.clever.web.mvc.annotation.RequestBody;
 
 import java.util.Map;
@@ -19,6 +20,44 @@ import java.util.Map;
 public class RcsController {
     static final SnowFlake snowFlake = new SnowFlake();
 
+    public static Model<?> agvToCharger(@RequestBody Map<String, Object> params) {
+        Object ret = getCommonParamAndCreateBizTask(params);
+        if (ret instanceof Model) {
+            // 异常
+            return (Model<Object>) ret;
+        }
+        RcsCommonParam ps = (RcsCommonParam) ret;
+
+        String targetWayPointId = Conv.asString(params.get("targetWayPointId"));
+        if (Strings.isNullOrEmpty(targetWayPointId)) {
+            return Model.newFail("targetWayPointId Must not be empty");
+        }
+        String targetDirection = Conv.asString(params.get("targetDirection"));
+        if (Strings.isNullOrEmpty(targetDirection)) {
+            targetDirection = ps.fromDirection.toString();
+        }
+
+        StaticItem toItem = ps.runtime.getStaticItemById(targetWayPointId);
+        if (toItem == null) {
+            return Model.newFail("target wayPoint not found!");
+        }
+
+        ps.bizTask.setTaskTo(targetWayPointId);
+
+        ChargerTask chargerTask = new ChargerTask(
+            ps.agvId, ps.bizTask.getTaskTo(), LCCDirection.fromString(targetDirection, ps.fromDirection)
+        );
+
+        ps.runtime.pathPlannerMap.get(ps.agv.getT())
+            .planChargerTask(ps.planSequence, ps.fromItem.getId(), ps.fromDirection, chargerTask);
+
+        ps.agv.logicX = ps.fromItem.logicX;
+        ps.agv.logicY = ps.fromItem.logicY;
+        ps.agv.dispatchTask(ps.planSequence);
+
+        return Model.newSuccess(ps.planSequence.toPrettyMap());
+    }
+
     public static Model<Object> agvMove(@RequestBody Map<String, Object> params) {
         Object ret = getCommonParamAndCreateBizTask(params);
         if (ret instanceof Model) {
@@ -222,9 +261,6 @@ public class RcsController {
         return Model.newSuccess(ps.planSequence.toPrettyMap());
     }
 
-    public static Model<Boolean> agvToCharger(@RequestBody Map<String, Object> params) {
-        throw new NotImplementedException("agvToCharger not implemented yet");
-    }
 
     public static Object getCommonParamAndCreateBizTask(@RequestBody Map<String, Object> params) {
         String projectUUID = Conv.asString(params.get("projectUUID"));