計算室內定位系統路線的算法

Question

我正在建立一個使用UWB的室內定位系統。我從硬件組件中準確獲取數據。在移動應用程序中，我有一個地板的平面圖（2D圖像），我有一個目的地。我已經有了實際字距與圖像像素的比值（米/像素）。此外，我有預先定義爲矩形的障礙。我被困在計算從A到B的路徑，給定了當前和目標座標，米/像素與障礙物的比率。

它不一定是在特定的平臺或語言;僞代碼很好，因爲我想知道算法背後的想法。有沒有一種算法產生類似於路線的輸出？

Answer 1

您必須將您的問題「映射」到一般問題Shortest Path Problem。 解決此問題的最流行和最有效的算法之一是Dijkstra algorithm。所以試着用它來解決你的問題。