使用3个不同点的距离找到我的位置的算法

时间:2012-09-26 21:32:14

标签: algorithm position

我正在尝试为机器人开发算法,该算法从机器人可见的三个不同点获取距离,假设每个点都是圆的中心,距离是该圆的半径,然后将机器人位置映射为这3个圆的交点。

我很难开发算法,甚至数学公式也会有所帮助。此外,我还有机器人和每个点之间的角度,但不知道在哪里使用它。

希望有人可以提供帮助。

2 个答案:

答案 0 :(得分:1)

假设三个点未对齐,您可以使用

进行验证
(y1 - y2)*(x1 - x3) != (y1 - y3)*(x1 - x2)

如果x1,x2和x3都不同;如果其中两个相等而第三个不相等,那么当然的三个点不能对齐,你不需要检查。

我们现在可以减少到一个已知的解决方案:

https://math.stackexchange.com/questions/110309/three-circle-intersection-for-circles-of-unbounded-integer-radius

你的机器人将在三个圆圈的交叉点。 (允许接受我的1个字符编辑的额外字符。)

答案 1 :(得分:0)