计算室内定位系统路线的算法

Question

我正在建立一个使用UWB的室内定位系统。我从硬件组件中准确获取数据。在移动应用程序中，我有一个地板的平面图（2D图像），我有一个目的地。我已经有了实际字距与图像像素的比值（米/像素）。此外，我有预先定义为矩形的障碍。我被困在计算从A到B的路径，给定了当前和目标坐标，米/像素与障碍物的比率。

它不一定是在特定的平台或语言;伪代码很好，因为我想知道算法背后的想法。有没有一种算法产生类似于路线的输出？

Answer 1

您必须将您的问题“映射”到一般问题Shortest Path Problem。 解决此问题的最流行和最有效的算法之一是Dijkstra algorithm。所以试着用它来解决你的问题。