自动选择路线问题

大佬可以指点下吗？我是个小萌新，假设途中线条都是轨道，轨道上不确定位置有数个点，在轨道上自由移动，请问假如每个点都到一个高度（一，二，三任意一个）途中不相撞，请 问代码如何实现，或者使用什么库啊，感激不尽啊，假设轨道上可以布置无数个位置传感器