Path Planning# From A* to Theta* and Lazy Theta*# https://www.cnblogs.com/yangrouchuan/p/6373285.html