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

Question

我在我的Android手机中用相机跟踪球，并通过蓝牙将x，y位置，球半径（x，y位置是屏幕安卓手机中的像素）发送到我的stm32f板。我将手机和stm32f1套件组装在移动机器人中。现在我希望我的机器人以固定的距离移动到球上。

Ex：我设置距离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语言编写代码。