|  |  |  | 
|---|
|  |  |  | package com.zy.acs.manager.core.service; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | import com.alibaba.fastjson.JSONObject; | 
|---|
|  |  |  | import com.zy.acs.framework.common.Cools; | 
|---|
|  |  |  | import com.zy.acs.common.enums.AgvDirectionType; | 
|---|
|  |  |  | import com.zy.acs.framework.common.Cools; | 
|---|
|  |  |  | import com.zy.acs.manager.common.utils.MapDataUtils; | 
|---|
|  |  |  | import com.zy.acs.manager.core.service.astart.*; | 
|---|
|  |  |  | import com.zy.acs.manager.core.service.astart.domain.DynamicNode; | 
|---|
|  |  |  | 
|---|
|  |  |  | import com.zy.acs.manager.manager.entity.Code; | 
|---|
|  |  |  | import com.zy.acs.manager.manager.entity.Loc; | 
|---|
|  |  |  | import com.zy.acs.manager.manager.service.ActionService; | 
|---|
|  |  |  | import com.zy.acs.manager.manager.service.CodeGapService; | 
|---|
|  |  |  | import com.zy.acs.manager.manager.service.CodeService; | 
|---|
|  |  |  | import com.zy.acs.manager.manager.service.RouteService; | 
|---|
|  |  |  | import com.zy.acs.manager.system.service.ConfigService; | 
|---|
|  |  |  | import lombok.extern.slf4j.Slf4j; | 
|---|
|  |  |  | import org.apache.commons.lang.time.StopWatch; | 
|---|
|  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | @Autowired | 
|---|
|  |  |  | private CodeService codeService; | 
|---|
|  |  |  | @Autowired | 
|---|
|  |  |  | private CodeGapService codeGapService; | 
|---|
|  |  |  | @Autowired | 
|---|
|  |  |  | private RouteService routeService; | 
|---|
|  |  |  | @Autowired | 
|---|
|  |  |  | private FloydNavigateService floydNavigateService; | 
|---|
|  |  |  | @Autowired | 
|---|
|  |  |  | 
|---|
|  |  |  | double deltaX = x1 - x0; | 
|---|
|  |  |  | double deltaY = y1 - y0; | 
|---|
|  |  |  | double angle = Math.atan2(deltaX, deltaY); | 
|---|
|  |  |  | int offsetAngle = Integer.parseInt(configService.getVal("mapXoffset")); | 
|---|
|  |  |  | int offsetAngle = configService.getVal("mapXoffset", Integer.class); | 
|---|
|  |  |  | angle = angle + offsetAngle; | 
|---|
|  |  |  | angle = Math.toDegrees(angle); | 
|---|
|  |  |  | angle = (angle + 360) % 360; // 将角度转换为正值 | 
|---|