2. Полигон испытаний: Настройка сред и рельефа
Для курсовой работы по пересеченной местности полигон «Сократа» настраивается через меню «🛠 Сцена» ➔ «🌄 Среда и Рельеф»:
- Карта высот (Relief / Heightmap)
- Загрузка черно-белого изображения (PNG / JPG).
- Белый цвет — максимальная возвышенность, черный — впадина.
- Высота настраивается параметром ReliefHeight (от холмов в 2 м до гор в 50 м).
- Движок автоматически строит сетку Three.js и натягивает коллизионную карту высот hfield в ядре MuJoCo.
- Физические среды и стихии
Через диалог «Параметры Среды и Мира» можно настроить:
- Пресная вода: Задается уровень зеркала воды (WaterLevel) и плотность (1000 кг/м³). Погруженные детали испытывают честную гидродинамическую силу Архимеда и сопротивление Стокса.
- Вязкие среды (Нефть/Грязь): Повышенная плотность и утроенный коэффициент сопротивления движению.
- Плотная атмосфера и ветер: Вектор бокового ветра (WindX) создает квадратичное аэродинамическое сопротивление при движении.
- Габариты мира: Масштабирование полигона от локальной комнаты (10 м) до открытого полигона (до 100 км) с автоподстройкой дальности обзора камеры.
- Архитектура робота и управление архетипами
В системе принята концепция префиксного паспорта цифрового двойника:
- $ (Железо и приводы): Например, $joint_wheel_left. Описывает тип шарнира, лимиты и жесткость ПИД-регулятора в формате JSON.
- # (Внутренний контроллер): Свойство #Controller. В нем содержится JavaScript-код конечного автомата, работающий автономно на борту робота.
- @ (Команды для внешнего мира и ИИ): Методы контроллера (например, @drive_forward, @stop, @take_photo), которые ИИ-агент или оператор могут вызывать удаленно.
Поддерживаемые земные архетипы
В библиотеке SocratesRobotics заложены 3 базовых класса движения (указываются первой строчкой в конфиге):
- wheeled (Колесные и гусеничные шасси): Дифференциальный привод, расчет скоростей левого/правого бортов по колее и радиусу колес.
- manipulator (Манипуляторы и руки): Прямое позиционирование звеньев в градусах, управление схватом/клешней.
- biped / quadruped (Шагающие платформы): Контроль углов наклона тела, детектирование падения и стабилизация по гироскопу.
- Пошаговое руководство: Создание контроллера
Шаг 1. Размещение робота
- В меню «🛠 Сцена» ➔ «🤖 Робототехника (URDF)» нажми «Поместить робота на полигон…» и выбери модель (например, четвероногого пса или тележку).
- Робот встанет на поверхность земли в точке клика.
Шаг 2. Открытие бортового редактора
- Нажми Правой Кнопкой Мыши (ПКМ) прямо по роботу в 3D-окне.
- В появившемся контекстном меню нажми «🧠 Контроллер (Скрипт)».
- Откроется полноэкранный редактор кода Monaco.
Шаг 3. Написание логики
Контроллер возвращает вызов фабрики SocratesRobotics.create({…}).
- Справочник 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)
Сенсоры опрашиваются автоматически с заданной частотой:
- Виртуальный гироскоп (robot.sensors.gyro):
- Построен по стандарту URDF (REP 103): ось +X+X — вперед (нос), +Z+Z — вверх (спина), +Y+Y — влево.
- sensors.gyro.pitch — тангаж (наклон корпуса вперед/назад в градусах).
- sensors.gyro.roll — крен (наклон влево/вправо в градусах).
- sensors.gyro.yaw — рысканье (компасный разворот).
- Виртуальный лидар (robot.sensors.lidar):
- Дистанция в метрах до ближайшего препятствия прямо по курсу робота.
- Возвращает -1, если в радиусе 30 метров преград нет.
- Бортовая камера (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.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 });
}
}
});
- Горячие клавиши и подсказки оператора
Пробел: Пауза / Возобновление физики.
W / E / R: Включение манипуляторов перемещения (W), вращения (E) и масштабирования (R) деталей в CAD-режиме.
Инструменты ➔ 🎛 Пульт суставов: Открытие ползунков для ручной проверки любого шарнира робота в реальном времени.
Инструменты ➔ 📷 Камера робота: Включение живого окна телеметрии (128×128) прямо в 3D-экране для визуального контроля курса