怎么样让它从当前坐标 相近的坐标 开始 寻路

Suky

循环计算当前位置与每个点的距离，然后根据距离排序
求距离可直接用此帖源码：
已知两点坐标求第三点坐标、求延长线上点的坐标等
https://bbs.125.la/forum.php?mod=viewthread&tid=14720820
(出处: 精易论坛)

  

子程序名	返回值类型	公开	备 注
Adm_求距离	双精度小数型		已知三维坐标系两个点的坐标，求两点之间距离；求二维时两点Z值0即可
参数名	类 型	参考	可空	数组	备 注
P_X1	双精度小数型				第1个点X坐标
P_Y1	双精度小数型				第1个点Y坐标
P_Z1	双精度小数型				第1个点Z坐标
P_X2	双精度小数型				第2个点X坐标
P_Y2	双精度小数型				第2个点Y坐标
P_Z2	双精度小数型				第2个点Z坐标

变量名	类 型	静态	数组	备 注
L_返回值	双精度小数型			所求长度
L_l1	双精度小数型			点1与点3（点2投影）之间的距离
L_l2	双精度小数型			点2与点3之间的距离

L_l1 ＝ 求平方根 (求次方 (P_X2 － P_X1, 2) ＋ 求次方 (P_Y2 － P_Y1, 2))  ' 两点在XY平面上投影的距离
判断 (P_Z2 ＝ P_Z1)
L_返回值 ＝ L_l1
L_l2 ＝ 取绝对值 (P_Z2 － P_Z1)  ' 两点在Z轴上投影的距离
L_返回值 ＝ 求平方根 (求次方 (L_l1, 2) ＋ 求次方 (L_l2, 2))
返回 (L_返回值)

.版本 2<br /> <br /> .子程序 Adm_求距离, 双精度小数型, 公开, 已知三维坐标系两个点的坐标，求两点之间距离；求二维时两点Z值0即可<br /> .参数 P_X1, 双精度小数型, , 第1个点X坐标<br /> .参数 P_Y1, 双精度小数型, , 第1个点Y坐标<br /> .参数 P_Z1, 双精度小数型, 可空, 第1个点Z坐标<br /> .参数 P_X2, 双精度小数型, , 第2个点X坐标<br /> .参数 P_Y2, 双精度小数型, , 第2个点Y坐标<br /> .参数 P_Z2, 双精度小数型, 可空, 第2个点Z坐标<br /> .局部变量 L_返回值, 双精度小数型, , , 所求长度<br /> .局部变量 L_l1, 双精度小数型, , , 点1与点3（点2投影）之间的距离<br /> .局部变量 L_l2, 双精度小数型, , , 点2与点3之间的距离<br /> <br /> L_l1 ＝ 求平方根 (求次方 (P_X2 － P_X1, 2) ＋ 求次方 (P_Y2 － P_Y1, 2))  ' 两点在XY平面上投影的距离<br /> .判断开始 (P_Z2 ＝ P_Z1)<br />     L_返回值 ＝ L_l1<br /> .默认<br />     L_l2 ＝ 取绝对值 (P_Z2 － P_Z1)  ' 两点在Z轴上投影的距离<br />     L_返回值 ＝ 求平方根 (求次方 (L_l1, 2) ＋ 求次方 (L_l2, 2))<br /> .判断结束<br /> 返回 (L_返回值)

补充内容 (2024-5-22 23:20):
不过好像也不需要排序，只需要取极值即可

Suky

11.e (953.65 KB, 下载次数: 4)

2024-5-22 23:42 上传

点击文件名下载附件

闲着也是闲着