https://1library.org/document/ye8le47y-orientation-enhanced-astar-algorithm-robotic-navigation.html