11、机器人运动控制与传感器编程指南

机器人运动控制与传感器编程指南

1. 机器人运动控制基础

1.1 简单运动代码

我们可以使用 Python 编写简单的代码来控制机器人的运动。例如，以下代码可以让机器人以 80% 的电机速度向前移动 1 秒：

import robot
from time import sleep
r = robot.Robot()
r.set_left(80)
r.set_right(80)
sleep(1)

这段代码的逻辑很简单，首先导入 robot 模块和 sleep 函数，然后创建一个 Robot 对象，接着设置左右电机的速度为 80，最后让程序暂停 1 秒。这种简化的代码结构使得我们可以在此基础上创建更多的行为。

1.2 编写路径跟随脚本

为了让机器人按照预定路径移动，我们可以编写一个路径跟随脚本。首先，我们需要定义一些辅助函数，用于控制机器人的直线行驶、转弯和旋转：

import robot
from time import sleep

def straight(bot, seconds):
    bot.set_left(80)
    bot.set_right(80)
    sleep(seconds)

def turn_left(bot, seconds):
    bot.set_left(20)
    bot.set_right(80)
    sleep(seco