Leo_starr的博客

A*算法启发式函数的几种距离欧氏距离曼哈顿距离对角距离0：Dijkstra算法欧氏距离double AstarPathFinder::getDistance_E(Vector3d n1 , Vector3d n2){ //Euclidean double dis_E = sqrt((n2(0)-n1(0))*(n2(0)-n1(0))+(n2(1)-n1(1))*(n2(1)-n1(1))+(n2(2)-n1(2))*(n2(2)-n1(2))); return dis_E;

版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。 ...