最短路径的Visual Lisp程序

目的 寻找连接两点的最近路线
前提 所有路线只在交点处交叉,起点和终点选择路线的端点.
核心函数 (main 起点 终点 是否显示搜索过程) 
返回值   (最短路线长度  最短路线途径实体表)
测试命令:tt

也欢迎大家就算法问题进行探讨交流。


应 nicoster 和各位网友的要求，贴出代码，供大家参考。
[php]
(defun z_timer (/ stime h m s)
  (if (not zhf_time_dot)
    (setq zhf_time_dot (getvar "date") h nil)
    (progn
      (setq stime (getvar "date"))
      (setq stime (- stime zhf_time_dot))
      (setq stime (* 86400.0 (- stime (fix stime))))
      (setq h (fix (/ stime 3600)))
      (setq m (fix (/ (- stime (* h 3600)) 60)))
      (setq s (fix (- stime (* m 60) (* h 3600))))
      (setq zhf_time_dot nil)
      
      (strcat (if (> h 0)
                (strcat (rtos h 2 0) "小时")""
              )
              (if (> m 0)
                (strcat (rtos m 2 0) "分钟")""
              )
              (rtos s 2 0)

              "秒"
      )
      )
    )
  )
(defun show (lst stop)
  (mapcar '(lambda (x) (redraw (vlax-vla-object->ename x) 3))
          lst
  )
  (if stop (progn(getpoint)
  (mapcar '(lambda (x) (redraw (vlax-vla-object->ename x) 4))
          lst
  )))
)
(defun ss2lst (ss vla / re e)
  (if ss
    (repeat (setq n (sslength ss))
      (if vla
        (setq e (vlax-ename->vla-object (ssname ss (setq n (1- n)))))
        (setq e (ssname ss (setq n (1- n))))
      )
      (setq re (append re (list e)))
    )
  )
  re
)
(defun getss@ (p)
  (ssget "c"
         p
         (polar p (/ pi 4) (/ (getvar "viewsize") 5000))