EV3寻路算法

Question

我正在尝试使用Python（EV3DEV）为乐高Mindstorms ev3编写一个路径查找算法。在

我可以使用以下传感器： -触摸 -陀螺 -超声波 -颜色

我要它穿过一个“走廊”，在那里它可能会撞到墙上，它必须向左或向右转弯（取决于是否有空间）。 我该如何使用传感器来确定它应该左转还是右转？（不会以倒退告终）

Answer 1

根据robot上剩余的端口数，我将配置您的robot如下。这是一个关于算法的高级示例

while True:
    if touch_pressed:
        drive backwards
        if right_ultra1 and right ultra2 clear:
            turnRight()
        else:
            turnLeft()
    drive_forward

基本上，机器人向前行驶，直到碰到物体。然后它会后退到刚好可以转弯而不会撞到墙。接下来，它检查传感器。由于传感器的位置尽可能接近机器人的长度，因此可以估计通道的狭窄程度。如果两个传感器都读取任意大的值，说明通道足够宽，否则通道不够宽。转动后/如果未按下传感器，则向前驱动。希望这有帮助！在