package com.zy.acs.manager.core; import com.baomidou.mybatisplus.core.conditions.query.LambdaQueryWrapper; import com.zy.acs.common.utils.GsonUtils; import com.zy.acs.framework.common.R; import com.zy.acs.framework.common.SnowflakeIdWorker; import com.zy.acs.manager.core.domain.Lane; import com.zy.acs.manager.manager.entity.Code; import com.zy.acs.manager.manager.entity.Route; import com.zy.acs.manager.manager.service.CodeService; import com.zy.acs.manager.manager.service.RouteService; import org.springframework.beans.factory.annotation.Autowired; import org.springframework.web.bind.annotation.GetMapping; import org.springframework.web.bind.annotation.RequestMapping; import org.springframework.web.bind.annotation.RestController; import java.util.*; import java.util.stream.Collectors; /** * Created by vincent on 10/24/2024 */ @RestController @RequestMapping("/test") public class DispatcherTestController { @Autowired private CodeService codeService; @Autowired private RouteService routeService; @Autowired private SnowflakeIdWorker snowflakeIdWorker; @GetMapping("/dfs") public R dfs() { List lanes = new ArrayList<>(); List codeList = codeService.list(new LambdaQueryWrapper().eq(Code::getStatus, 1)); Map> adjacencyCodeMap = new HashMap<>(); for (Code code : codeList) { List adjacencyNode = routeService.getAdjacencyNode(code.getId()); adjacencyCodeMap.put(code.getData(), adjacencyNode.stream().map(node -> { return codeService.getById(node).getData(); }).collect(Collectors.toList())); } List codeDataList = codeList.stream().map(Code::getData).collect(Collectors.toList()); System.out.println(codeDataList.toString()); System.out.println(adjacencyCodeMap.toString()); Set visited = new HashSet<>(); for (String codeData : codeDataList) { if (adjacencyCodeMap.get(codeData).size() != 2) { if (!visited.contains(codeData)) { Lane lane = new Lane(String.valueOf(snowflakeIdWorker.nextId()).substring(3)); dfsCalc(codeData, null, lane, visited, adjacencyCodeMap); lanes.add(lane); } } } System.out.println(GsonUtils.toJson(lanes)); return R.ok().add(lanes); } private void dfsCalc(String code, String parent, Lane lane, Set visited, Map> adjacencyCodeMap) { visited.add(code); lane.getCodes().add(code); List neighbors = adjacencyCodeMap.get(code); if (neighbors == null || neighbors.isEmpty()) { return; } for (String neighbor : neighbors) { if (parent != null && neighbor.equals(parent)) { continue; } if (!visited.contains(neighbor) && isSameDirection(code, neighbor, parent)) { dfsCalc(neighbor, code, lane, visited, adjacencyCodeMap); } } } public boolean isSameDirection(String code, String neighbor, String parent) { if (parent == null) { return true; } Code parentCode = codeService.selectByData(parent); Code currentCode = codeService.selectByData(code); Code neighborCode = codeService.selectByData(neighbor); double direction1 = calculateDirection(parentCode, currentCode); double direction2 = calculateDirection(currentCode, neighborCode); double angleDifference = Math.abs(direction1 - direction2); angleDifference = Math.min(angleDifference, 2 * Math.PI - angleDifference); return angleDifference < Math.toRadians(3); } public double calculateDirection(Code from, Code to) { double deltaX = to.getX() - from.getX(); double deltaY = to.getY() - from.getY(); return Math.atan2(deltaY, deltaX); } }