роботы робототехника микроконтроллеры

Робот, избегающий препятствия, с ультразвуковым датчиком HC-SR04

Схема и программа для робота на микроконтроллере ESP32

Робот едет вперед, а если обнаруживает препятствие, то отъезжает назад, поворачивает и продолжает движение вперед.

Левый мотор подключен к GPIO26 и GPIO32.
Правый мотор подключен к GPIO25 и GPIO33.
Вывод Echo у датчика HC-SR04 подключен к GPIO36.
Вывод Trig у датчика HC-SR04 подключен к GPIO27.


Монтажная схема робота


Программа для робота:

from machine import Pin, time_pulse_us
from time import sleep, sleep_us
from random import randint

# Пины моторов
left_motor_forward = Pin(26, Pin.OUT)
left_motor_backward = Pin(32, Pin.OUT)

right_motor_forward = Pin(25, Pin.OUT)
right_motor_backward = Pin(33, Pin.OUT)

# Пины ультразвукового датчика
trigger_pin = Pin(27, Pin.OUT)
echo_pin = Pin(36, Pin.IN)

# Функция измерения расстояния
def get_distance(trigger, echo):
    trigger.value(0)
    sleep_us(2)
    trigger.value(1)
    sleep_us(10)
    trigger.value(0)
    return time_pulse_us(echo, 1) * 0.0343 / 2

# Управление моторами
def stop():
    left_motor_forward.value(0)
    left_motor_backward.value(0)
    right_motor_forward.value(0)
    right_motor_backward.value(0)

def forward():
    left_motor_forward.value(1)
    left_motor_backward.value(0)
    right_motor_forward.value(1)
    right_motor_backward.value(0)

def backward():
    left_motor_forward.value(0)
    left_motor_backward.value(1)
    right_motor_forward.value(0)
    right_motor_backward.value(1)

def turn_right():
    left_motor_forward.value(1)
    left_motor_backward.value(0)
    right_motor_forward.value(0)
    right_motor_backward.value(1)

def turn_left():
    left_motor_forward.value(0)
    left_motor_backward.value(1)
    right_motor_forward.value(1)
    right_motor_backward.value(0)

# Основной цикл
while True:
    distance = get_distance(trigger_pin, echo_pin)

    if distance > 20:
        forward()
    else:
        stop()
        sleep(0.2)

        backward()
        sleep(1)

        stop()
        sleep(0.2)

        # Случайный выбор поворота
        if randint(0, 1) == 0:
            turn_left()
        else:
            turn_right()
        time.sleep(0.5)

        stop()
        time.sleep(0.2)

    time.sleep(0.2)
  1. WIKI (главная)
  2. ОСНОВЫ
  3. КОМПОНЕНТЫ
  4. МИКРОКОНТРОЛЛЕРЫ
  5. ПРОГРАММИРОВАНИЕ
  6. ПРОЕКТЫ
  7. РОБОТЫ
  8. СОВЕТЫ и ХИТРОСТИ
.