机器人如何跟踪固定距离的球？

Question

我正在用 android phone 中的摄像头跟踪球并发送球的 x、y 位置和半径（x、y 位置是屏幕中的一个像素 android phone ) 通过蓝牙连接到我的 stm32f 板。我 assemble 我的 phone 和 stm32f1 套件在移动机器人中。现在我希望我的机器人以固定距离移动到球上。

例如：我设置距离 10cm。当我向前移动球时，我的机器人向前移动并始终保持机器人与球之间的 10 厘米

Answer 1

这里有一些伪代码可以帮助您入门：

while (TRUE) do
    get x, y position of ball
    get x, y position of self
    calculate distance between self and ball (hint: use Pythagoras)
    if (distance < 10 cm)
        move away from ball
    else if (distance < 10 cm)
        move towards ball
end

现在您所要做的就是用 C 编写代码。