2. Полигон испытаний: Настройка сред и рельефа

Для курсовой работы по пересеченной местности полигон «Сократа» настраивается через меню «🛠 Сцена» ➔ «🌄 Среда и Рельеф»:

 

  1. Карта высот (Relief / Heightmap)
  • Загрузка черно-белого изображения (PNG / JPG).
  • Белый цвет — максимальная возвышенность, черный — впадина.
  • Высота настраивается параметром ReliefHeight (от холмов в 2 м до гор в 50 м).
  • Движок автоматически строит сетку Three.js и натягивает коллизионную карту высот hfield в ядре MuJoCo.

 

  1. Физические среды и стихии

Через диалог «Параметры Среды и Мира» можно настроить:

  • Пресная вода: Задается уровень зеркала воды (WaterLevel) и плотность (1000 кг/м³). Погруженные детали испытывают честную гидродинамическую силу Архимеда и сопротивление Стокса.
  • Вязкие среды (Нефть/Грязь): Повышенная плотность и утроенный коэффициент сопротивления движению.
  • Плотная атмосфера и ветер: Вектор бокового ветра (WindX) создает квадратичное аэродинамическое сопротивление при движении.
  • Габариты мира: Масштабирование полигона от локальной комнаты (10 м) до открытого полигона (до 100 км) с автоподстройкой дальности обзора камеры.

 

  1. Архитектура робота и управление архетипами

В системе принята концепция префиксного паспорта цифрового двойника:

  • $ (Железо и приводы): Например, $joint_wheel_left. Описывает тип шарнира, лимиты и жесткость ПИД-регулятора в формате JSON.
  • # (Внутренний контроллер): Свойство #Controller. В нем содержится JavaScript-код конечного автомата, работающий автономно на борту робота.
  • @ (Команды для внешнего мира и ИИ): Методы контроллера (например, @drive_forward, @stop, @take_photo), которые ИИ-агент или оператор могут вызывать удаленно.

Поддерживаемые земные архетипы

В библиотеке SocratesRobotics заложены 3 базовых класса движения (указываются первой строчкой в конфиге):

  1. wheeled (Колесные и гусеничные шасси): Дифференциальный привод, расчет скоростей левого/правого бортов по колее и радиусу колес.
  2. manipulator (Манипуляторы и руки): Прямое позиционирование звеньев в градусах, управление схватом/клешней.
  3. biped / quadruped (Шагающие платформы): Контроль углов наклона тела, детектирование падения и стабилизация по гироскопу.

 

  1. Пошаговое руководство: Создание контроллера

Шаг 1. Размещение робота

  1. В меню «🛠 Сцена» ➔ «🤖 Робототехника (URDF)» нажми «Поместить робота на полигон…» и выбери модель (например, четвероногого пса или тележку).
  2. Робот встанет на поверхность земли в точке клика.

 

Шаг 2. Открытие бортового редактора

  1. Нажми Правой Кнопкой Мыши (ПКМ) прямо по роботу в 3D-окне.
  2. В появившемся контекстном меню нажми «🧠 Контроллер (Скрипт)».
  3. Откроется полноэкранный редактор кода Monaco.

 

Шаг 3. Написание логики

Контроллер возвращает вызов фабрики SocratesRobotics.create({…}).

 

  1. Справочник API (SocratesRobotics)

Структура конфигурации

codeJavaScript

return SocratesRobotics.create({

archetype: “wheeled” | “manipulator” | “biped”,

frequency: 20, // Частота выполнения цикла Main в Герцах (раз в секунду)

// Конфигурация колес (только для archetype: “wheeled”)

wheeled: {

leftWheels: [“j_wheel_l1”, “j_wheel_l2”],   // Имена суставов из паспорта $

rightWheels: [“j_wheel_r1”, “j_wheel_r2”],

wheelRadius: 0.1, // Радиус колеса в метрах

trackWidth: 0.4   // Расстояние между колесами левого и правого борта

},

// Конфигурация манипулятора (только для archetype: “manipulator”)

manipulator: {

joints: [“j_shoulder”, “j_elbow”, “j_wrist”],

gripperJoint: “j_gripper”,

openVal: 0.04

},

commands: { /* Высокоуровневые команды @ */ },

Main: function(robot) { /* Цикл непрерывного контроля */ }

});

 

Бортовые сенсоры (robot.sensors)

Сенсоры опрашиваются автоматически с заданной частотой:

  1. Виртуальный гироскоп (robot.sensors.gyro):
  • Построен по стандарту URDF (REP 103): ось +X+X — вперед (нос), +Z+Z — вверх (спина), +Y+Y — влево.
  • sensors.gyro.pitch — тангаж (наклон корпуса вперед/назад в градусах).
  • sensors.gyro.roll — крен (наклон влево/вправо в градусах).
  • sensors.gyro.yaw — рысканье (компасный разворот).

 

  1. Виртуальный лидар (robot.sensors.lidar):
  • Дистанция в метрах до ближайшего препятствия прямо по курсу робота.
  • Возвращает -1, если в радиусе 30 метров преград нет.

 

  1. Бортовая камера (robot.camera.getSnapshot(options)):

Формирует статический снимок из глаз робота (по направлению носа +X+X).

Параметры:

  • width, height: разрешение кадра (например, 128 на 128).
  • grayscale: true — черно-белое изображение (Luma), false — цветной RGB.

Возвращает компактную строку data:image/jpeg;base64,….

 

Актуаторы движения

Колеса (robot.chassis):

  • chassis.drive(linearSpeed, angularSpeed) — ехать с линейной скоростью (м/с) и угловой скоростью поворота (рад/с).
  • chassis.stop() — полная блокировка вращения приводов.

Манипулятор (robot.arm):

  • arm.setJoints([angle1, angle2, …]) — поворот суставов в градусах.
  • arm.setGripper(true / false) — открыть или закрыть схват.

Прямой доступ к любому мотору:

  • setJointVelocity(“имя_сустава”, radPerSec)
  • setJointPosition(“имя_сустава”, radians)

 

Связь с ядром и ИИ

robot.emit(eventName, payload): Отправка сообщения в ядро «Сократа». Данные упаковываются в системное сообщение _CompositeMessage, подписываются именем робота и поступают на обработку ИИ-агентам или сохраняются в графовой базе.

 

  1. Готовые примеры контроллеров для курсовой работы

Пример 1: Колесный робот-разведчик на пересеченной местности

Робот движется вперед по рельефу, непрерывно сканирует путь лидаром. При обнаружении камня или подъема ближе 1.2 м он останавливается, делает снимок бортовой камерой 128×128 (Ч/Б), отправляет сигнал тревоги с фотографией ИИ-агенту и выполняет объездной маневр.

codeJavaScript

return SocratesRobotics.create({

archetype: “wheeled”,

frequency: 10, // 10 Гц

wheeled: {

leftWheels: [“j_wheel_front_left”, “j_wheel_back_left”],

rightWheels: [“j_wheel_front_right”, “j_wheel_back_right”],

wheelRadius: 0.12,

trackWidth: 0.38

},

commands: {

// Команда для ИИ: запустить автоматическое патрулирование

“@start_patrol”: function(robot, args) {

robot.memory.mode = “patrol”;

robot.chassis.drive(1.2, 0.0);

},

// Команда для ИИ: принудительно остановиться

“@stop”: function(robot) {

robot.memory.mode = “idle”;

robot.chassis.stop();

}

},

Main: function(robot) {

// Инициализация памяти при первом запуске

if (!robot.memory.mode) robot.memory.mode = “idle”;

if (robot.memory.mode === “patrol”) {

// 1. Проверка крутизны склона по гироскопу

if (Math.abs(robot.sensors.gyro.pitch) > 30) {

robot.chassis.stop();

robot.memory.mode = “danger”;

robot.emit(“SLOPE_DANGER”, { pitch: robot.sensors.gyro.pitch });

return;

}

// 2. Детекция препятствия лидаром

if (robot.sensors.lidar > 0 && robot.sensors.lidar < 1.2) {

robot.chassis.stop();

// Делаем компактный Ч/Б снимок препятствия для VLM-агента

var photo = robot.camera.getSnapshot({ width: 128, height: 128, grayscale: true });

// Шлем фото и дистанцию в шину ИИ

robot.emit(“OBSTACLE_DETECTED”, {

dist: robot.sensors.lidar,

image: photo

});

// Маневр уклонения: разворот на месте

robot.memory.mode = “avoiding”;

robot.memory.avoidTicks = 15; // 1.5 секунды поворота

}

}

else if (robot.memory.mode === “avoiding”) {

robot.chassis.drive(0.0, 1.5); // Вращение на месте

robot.memory.avoidTicks–;

if (robot.memory.avoidTicks <= 0) {

robot.memory.mode = “patrol”;

robot.chassis.drive(1.0, 0.0); // Продолжение движения

}

}

}

});

 

Пример 2: Четвероногий робот (Контроль равновесия на косогоре)

Робот контролирует устойчивость на сложном грунте. Если угол крена превышает критический порог (риск опрокидывания), он экстренно останавливает приводы, понижает центр тяжести и передает отчет координатору.

codeJavaScript

return SocratesRobotics.create({

archetype: “biped”,

frequency: 20, // 20 Гц для быстрой реакции на крен

commands: {

“@stand_still”: function(robot) {

robot.memory.state = “standing”;

}

},

Main: function(robot) {

var pitch = robot.sensors.gyro.pitch;

var roll = robot.sensors.gyro.roll;

// Контроль опрокидывания на пересеченной местности

if (Math.abs(roll) > 35 || Math.abs(pitch) > 40) {

robot.emit(“CRITICAL_FALL”, {

alert: “Опрокидывание корпуса!”,

roll: roll,

pitch: pitch

});

// Делаем цветной снимок горизонта для фиксации положения

var crashFrame = robot.camera.getSnapshot({ width: 128, height: 128, grayscale: false });

robot.emit(“CRASH_FRAME”, { base64: crashFrame });

}

}

});

 

  1. Горячие клавиши и подсказки оператора

Пробел: Пауза / Возобновление физики.

W / E / R: Включение манипуляторов перемещения (W), вращения (E) и масштабирования (R) деталей в CAD-режиме.

Инструменты ➔ 🎛 Пульт суставов: Открытие ползунков для ручной проверки любого шарнира робота в реальном времени.

Инструменты ➔ 📷 Камера робота: Включение живого окна телеметрии (128×128) прямо в 3D-экране для визуального контроля курса