计算中间点到目标点行走距离

Junjie

2023-07-21 0e7e7a9317894a0bac09e1cb83c9be628e8b4ca5

计算中间点到目标点行走距离

 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java

@@ -938,13 +938,13 @@
                middlePath = nodes.get(nodes.size() - 3);
                //通过xy坐标小车二维码
                middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());
                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes);//计算中间点到目标点行走距离
                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, 3);//计算中间点到目标点行走距离
            } else if (nodes.size() > 5) {//中段码传倒数第二个
                //中间路径
                middlePath = nodes.get(nodes.size() - 2);
                //通过xy坐标小车二维码
                middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());
                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes);//计算中间点到目标点行走距离
                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, 2);//计算中间点到目标点行走距离
            }

            //目标路径
@@ -1008,13 +1008,13 @@
                    middlePath = nodes.get(nodes.size() - 3);
                    //通过xy坐标小车二维码
                    middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());
                    middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes);//计算中间点到目标点行走距离
                    middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, 3);//计算中间点到目标点行走距离
                } else if (nodes.size() > 5) {//中段码传倒数第二个
                    //中间路径
                    middlePath = nodes.get(nodes.size() - 2);
                    //通过xy坐标小车二维码
                    middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());
                    middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes);//计算中间点到目标点行走距离
                    middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, 2);//计算中间点到目标点行走距离
                }

                //目标路径
@@ -1060,13 +1060,13 @@
                middlePath = nodes.get(nodes.size() - 3);
                //通过xy坐标小车二维码
                middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());
                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes);//计算中间点到目标点行走距离
                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, 3);//计算中间点到目标点行走距离
            } else if (nodes.size() > 5) {//中段码传倒数第二个
                //中间路径
                middlePath = nodes.get(nodes.size() - 2);
                //通过xy坐标小车二维码
                middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());
                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes);//计算中间点到目标点行走距离
                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, 2);//计算中间点到目标点行走距离
            }

            //目标路径

 src/main/java/com/zy/common/utils/NavigateUtils.java

@@ -222,9 +222,9 @@
    /**
     * 获取中间点到目标点行走距离
     */
    public static Integer getMiddleToDistDistance(List<NavigateNode> path) {
    public static Integer getMiddleToDistDistance(List<NavigateNode> path, Integer distance) {
        //中间路径
        NavigateNode middlePath = path.get(path.size() - 2);
        NavigateNode middlePath = path.get(path.size() - distance);
        return middlePath.getMoveDistance();
    }