Алгоритм программирования робота: от блок-схемы до работающей программы

Блог 100xbot · 25.09.2026 · обновлено 05.10.2026 · редакция 100xbot

Определение, базовые конструкции и одна задача, доведённая до программы: робот-собака идёт до препятствия, останавливается, поворачивает и идёт дальше.

Страница для преподавателей, студентов и инженеров, которым нужно объяснить или освоить программирование движения робота на примере. Сначала - короткое определение алгоритма и его свойств, как в курсе информатики. Затем одна задача проходит весь путь: словесный алгоритм, конечный автомат, программа на Python. Дальше - уровни программирования на моделях каталога, отладка на настоящем роботе-собаке, типичные ошибки и требования для технического задания на закупку.

Робот-собака в лаборатории перед препятствием, рядом ноутбук с программой управления
Иллюстрация

Что такое алгоритм в программировании простого робота

Алгоритм программирования робота - это конечная последовательность точных команд, которая приводит робота из начального состояния к цели: дойти до точки, объехать препятствие, взять предмет. Команды робота бывают двух видов: действия (идти, повернуть, остановиться) и проверки условий по датчикам (есть ли препятствие, достигнута ли точка).

Программа - тот же алгоритм, записанный на языке контроллера: блоками в графическом редакторе, командами SDK на Python или узлами ROS 2. Свойства алгоритма те же, что в учебнике:

Алгоритмические конструкции: примеры для робота

Программа робота собирается из конструкций в таблице ниже, а программирование движения сводится к циклу управления: опросить датчики, принять решение, выдать команду, повторить через фиксированный интервал.

КонструкцияЧто означаетПример для робота
СледованиеКоманды идут одна за другойВстать, пройти вперёд, лечь
ВетвлениеВыбор действия по условиюЕсли до препятствия меньше 0,6 м - остановиться, иначе идти
ЦиклПовтор, пока верно условиеПока впереди свободно - идти и опрашивать датчик
ПодпрограммаИменованный блок команд«Повернуть на 90°» вызывается из разных мест программы
Параллельные процессыНесколько задач одновременноОдин поток ведёт робота, второй следит за батареей и связью
Конечный автоматСостояния и переходы между ними«Иду», «стою», «поворачиваю», «авария»

Задача: дойти до препятствия, остановиться, повернуть, продолжить

Сначала алгоритм записывают словами: так видно, какие команды и данные датчиков ему нужны.

Тот же алгоритм как конечный автомат

Таблица переходов - это блок-схема в компактной записи: строки соответствуют блокам действий, условия - ромбам. Её проверяют до написания кода: у каждого состояния есть выход, у каждого ожидания - предел по времени.

Два порога вместо одного - это гистерезис: при одном пороге шум датчика заставляет робота то идти, то тормозить.

СостояниеУсловие переходаДействие
ВПЕРЁДРасстояние меньше 0,6 м - в ТОРМОЖЕНИЕИдти прямо, 0,3 м/с
ТОРМОЖЕНИЕПрошло 0,5 с - в ПОВОРОТОстановиться
ПОВОРОТРасстояние больше 1,2 м - во ВПЕРЁД; прошло 10 с - в АВАРИЮВращаться на месте, 0,6 рад/с
АВАРИЯПереходов нет, выход из циклаОстановиться, сообщить причину

Программа на Python

Код запускается на обычном компьютере без робота: в класс Robot встроена простейшая симуляция стены впереди. Это учебный интерфейс из трёх методов - move(vx, wz), stop() и distance_ahead(). Он придуман для статьи и не является программным интерфейсом Unitree или другого производителя.

На настоящем роботе тела этих методов заменяют вызовами SDK конкретной модели: реальные имена функций, единицы измерения и способ получить расстояние берутся из документации производителя. Логика автомата не меняется. Блок finally выдаёт команду остановки при любом завершении программы, включая ошибку.

import math
import time
from enum import Enum, auto

SPEED = 0.3          # м/с - малая скорость для отладки
TURN_RATE = 0.6      # рад/с - скорость поворота на месте
STOP_DIST = 0.6      # м - ближе этого останавливаемся
CLEAR_DIST = 1.2     # м - дальше этого путь свободен
PAUSE = 0.5          # с - пауза после остановки
TURN_TIMEOUT = 10.0  # с - дольше не поворачиваем
PERIOD = 0.05        # с - шаг цикла управления


class Robot:
    """Учебный интерфейс с простейшей симуляцией вместо железа.
    На реальном роботе тела методов заменяют вызовами SDK модели."""

    def __init__(self):
        self._gap = 2.0      # расстояние до стены впереди, м
        self._turned = 0.0   # накопленный угол поворота, рад
        self._vx = 0.0
        self._wz = 0.0

    def move(self, vx, wz):
        """Задать скорость: vx - вперёд, м/с; wz - поворот, рад/с."""
        self._vx, self._wz = vx, wz

    def stop(self):
        self.move(0.0, 0.0)

    def distance_ahead(self):
        """Расстояние до препятствия впереди, м."""
        # Симуляция: каждый опрос сдвигает модель мира на один шаг.
        self._gap -= self._vx * PERIOD
        self._turned += abs(self._wz) * PERIOD
        if self._turned >= math.pi / 2:  # повернули на 90° - впереди свободно
            self._gap, self._turned = 2.0, 0.0
        return self._gap


class State(Enum):
    FORWARD = auto()
    BRAKE = auto()
    TURN = auto()
    FAULT = auto()


def run(robot, duration=30.0):
    state = State.FORWARD
    entered = time.monotonic()           # момент входа в текущее состояние
    t_end = entered + duration
    try:
        while time.monotonic() < t_end and state is not State.FAULT:
            now = time.monotonic()
            dist = robot.distance_ahead()
            new_state = state

            if state is State.FORWARD:
                if dist < STOP_DIST:
                    new_state = State.BRAKE
                else:
                    robot.move(SPEED, 0.0)
            elif state is State.BRAKE:
                robot.stop()
                if now - entered >= PAUSE:
                    new_state = State.TURN
            elif state is State.TURN:
                if dist > CLEAR_DIST:
                    new_state = State.FORWARD
                elif now - entered > TURN_TIMEOUT:
                    new_state = State.FAULT
                else:
                    robot.move(0.0, TURN_RATE)

            if new_state is not state:
                print(f"{now:8.2f} с  {state.name} -> {new_state.name}  dist={dist:.2f} м")
                state, entered = new_state, now
            time.sleep(PERIOD)
    finally:
        robot.stop()  # выполняется при любом выходе, включая Ctrl+C
    return state


if __name__ == "__main__":
    result = run(Robot())
    print("Завершено, последнее состояние:", result.name)

Уровни программирования и модели каталога

Наш пример - высокоуровневые команды SDK, вторая строка таблицы: программа задаёт скорость корпуса, а походку и равновесие держит штатный контроллер робота.

УровеньЧто пишет программистМодели каталога
Графический редакторЦепочку готовых блоков, без кодаGo2 EDU, Go2 EDU U2 - в приложении; BUMI EDU Pro - редактор сценариев
Высокоуровневые команды SDKСкорость корпуса, готовые движения, чтение датчиковGo2 EDU, Go2 EDU U2, BUMI EDU Pro; PiPER - Python SDK руки
Низкоуровневое управление суставамиКоманды отдельным приводам, свой регулятор или обученную политикуGo2 EDU, Go2 EDU U2 - низкий уровень SDK; BUMI EDU Pro - доступ к суставам; PiPER - по CAN
ROS 2Узлы и топики, пакеты навигации и планированияВсе четыре; у PiPER также ROS 1, URDF и MoveIt

Go2: что работает без программирования, а что требует кода

В каталоге обе конфигурации Go2 учебные: Go2 EDU - от 1 190 000 ₽, Go2 EDU U2 - от 1 790 000 ₽. EDU-версия получает вычислитель Jetson Orin и полный SDK с низкоуровневым доступом.

Чек-лист отладки алгоритма на реальном роботе

Типичные ошибки новичков

Ограничения примера

Пример учит структуре программы, а не автономной навигации: он не строит карту, не планирует маршрут и не отличает стену от человека. Дальномер «вперёд» - упрощение: на роботе-собаке расстояние получают из облака точек лидара или карты глубины, и этот код придётся написать или взять из примеров SDK. Задача «дойти до нужного кабинета» требует локализации и планировщика маршрута - это отдельная разработка.

Для закупки учебного робота

В техническом задании описывайте не марку, а уровни доступа: графическая среда программирования, SDK на Python и C++, поддержка ROS 2, низкоуровневое управление приводами, бортовой вычислитель, лидар.

Оплата - по счёту и договору поставки, возможны закупки по 44-ФЗ и 223-ФЗ. Складские позиции поставляются за 1-2 недели, под заказ - за 6-10 недель с учётом логистики и таможни; точный срок фиксируется в договоре. При поставке передаём договор, спецификацию, счёт, УПД, паспорт изделия и инструкцию на русском языке. Гарантия производителя - 12 месяцев.

Скачать шаблон ТЗ по 44-ФЗ

Модели каталога для курса программирования

Вопросы и ответы

Что такое алгоритм в программировании простого робота?

Конечная последовательность однозначных команд и проверок по датчикам, которая приводит робота к цели. Пример: идти вперёд, пока до стены больше 0,6 м, затем остановиться и повернуть.

На каком языке программируют робота-собаку?

Простые сценарии собирают из блоков в графическом редакторе приложения. Остальное пишут на Python или C++ через SDK и ROS 2: у Go2 EDU открыты оба уровня SDK.

Можно ли запустить код из статьи на Unitree Go2?

Логику - да, интерфейс - нет: класс Robot в примере учебный. Три его метода нужно реализовать через SDK модели: команду скорости, остановку и расчёт расстояния по данным лидара.

Чем блок-схема отличается от конечного автомата?

Блок-схема показывает порядок действий, автомат - состояния и условия перехода. Для робота, который постоянно реагирует на датчики, автомат удобнее: поведение умещается в таблицу.

Какой робот из каталога подойдёт для курса программирования?

Для движения и навигации - Go2 EDU от 1 190 000 ₽, для манипуляции - PiPER от 460 000 ₽, для гуманоидной тематики - BUMI EDU Pro от 790 000 ₽. Все три поддерживают Python и ROS 2.

Смотрите также

+7 926 443-41-73 · info@100xbot.ru
Горчаков Григорий Григорьевич, индивидуальный предприниматель · ИНН 501306632267 · ОГРНИП 311504014600060 · 119234, г. Москва, Раменский бульвар, д. 1, кластер «Ломоносов». Оплата по счёту и договору.
Каталог · Решения · Блог · О компании · Доставка и оплата · Контакты · Политика обработки персональных данных · Согласие