解方程参考:https://zhuanlan.zhihu.com/p/24893371html
缺点太慢,最后仍是本身算了htm
距离公式参考:https://www.cnblogs.com/denny402/p/7027954.htmlblog
总结的很好总结