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

Question

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

例如:我设置距离 10 厘米。当我向前移动球时，我的机器人向前靠近球，并且机器人与球始终保持 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 语言编写代码。