0

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

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

希望有人可以提供帮助。

4

2 回答 2

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 个字符编辑被接受)。

于 2012-09-26T21:45:23.857 回答
0

三边测量。http://en.wikipedia.org/wiki/Trilateration

于 2012-09-26T21:45:35.087 回答