| | |
| | | List<Action> actionList = new ArrayList<>(); |
| | | // start node |
| | | Code lastCode = codeService.getById(agvDetail.getRecentCode()); |
| | | Double lastDirection = agvDetail.getAgvAngle(); |
| | | if (!lastCode.getData().equals(pathList.get(0))) { |
| | | throw new CoolException("AGV[" + agv.getUuid() + "]定位偏移..."); |
| | | } |
| | | |
| | | Double lastDirection = agvDetail.getAgvAngle(); |
| | | boolean first = true; |
| | | |
| | | for (Segment segment : segmentList) { |
| | | |
| | | // 分段所属的Task |
| | |
| | | break; |
| | | case TO_CHARGE: |
| | | // 检验方向 |
| | | FuncSta chargeFuncSta = funcStaService.query(agvId, lastCode.getId(), FuncStaType.CHARGE.toString()); |
| | | FuncSta chargeFuncSta = funcStaService.query(lastCode.getId(), FuncStaType.CHARGE.toString()); |
| | | Double chargeDirection = Double.parseDouble(chargeFuncSta.getAngle()); |
| | | if (!lastDirection.equals(chargeDirection)) { |
| | | actionList.add(new Action( |