Сколькими способами это может двигаться?
Степени свободы: геометрия движения
Степень свободы (DOF) — это один независимый способ движения объекта. Понимание DOF — первый шаг в понимании того, как роботы взаимодействуют с пространством.
Положение в трёхмерном пространстве требует 3 DOF: x (влево/вправо), y (вперёд/назад), z (вверх/вниз). Точка в пространстве имеет 3 DOF.
Ориентация добавляет ещё 3: крен (вращение вокруг оси движения вперед), тангаж (вращение вокруг боковой оси), рыскание (вращение вокруг вертикальной оси). Твердое тело в пространстве имеет 6 DOF: 3 положения + 3 ориентации.
Роботизированные манипуляторы и DOF:
- 6-осевой шарнирный манипулятор (например промышленный робот) имеет 6 суставов, каждый добавляет 1 DOF. С 6 DOF конечный рабочий орган может достичь любого положения и ориентации в рабочей области: он имеет полную пространственную свободу.
- 4-осевой робот SCARA имеет 4 DOF: он может позиционироваться в любом месте плоскости и вращаться, но не может наклонять свой инструмент. Подходит для операций захвата и размещения на плоских поверхностях.
- 3-осевой декартов/портальный робот имеет 3 DOF: он может позиционироваться в любом месте объёма в форме куба, но совсем не может ориентировать свой инструмент. Подходит для 3D-принтеров.
Более 6 DOF: 7-осевой робот избыточен: он имеет больше DOF, чем нужно для полного пространственного позиционирования. Дополнительный DOF позволяет ему доставать вокруг препятствий, как человеческая рука, тянущаяся за что-то. Избыточность — геометрическое преимущество.
DOF и требования задачи
Завод нуждается в роботе для трёх различных задач: (A) нанесение клея вдоль трёхмерного криволинейного пути на панель кузова автомобиля, (B) сбор микросхем с конвейерной ленты и их размещение на плоской печатной плате, (C) сварка сложного трёхмерного соединения с разных углов.
Два направления робототехнической геометрии
Кинематика: геометрия в движении
Кинематика — это изучение движения без учёта сил. В робототехнике это чистая геометрия: взаимосвязь между углами суставов и положением конечного рабочего органа.
Прямая кинематика (FK): Даны все углы суставов → вычислить положение и ориентацию конечного рабочего органа. Это 'лёгкое' направление.
Для 2-звенного плоского манипулятора: если сустав 1 под углом θ₁ и сустав 2 под углом θ₂, с длинами звеньев L₁ и L₂, конечный рабочий орган находится в:
- x = L₁ cos(θ₁) + L₂ cos(θ₁ + θ₂)
- y = L₁ sin(θ₁) + L₂ sin(θ₁ + θ₂)
Для 6-осевого манипулятора FK использует цепь матриц однородного преобразования: каждый сустав добавляет матрицу 4×4, кодирующую поворот и трансляцию. Умножьте все шесть матриц вместе, чтобы получить позу конечного рабочего органа. Это механическое, но всегда дает уникальный ответ.
Обратная кинематика (IK): Дано желаемое положение и ориентация конечного рабочего органа → вычислить углы суставов, которые это достигают. Это 'сложное' направление.
IK сложна, потому что:
- Множественные решения: 6-осевой манипулятор часто может достичь одной и той же точки в нескольких конфигурациях (локоть вверх против локтя вниз, запястье перевёрнуто или нет). Может быть 8 или более допустимых решений.
- Отсутствие решений: Если цель находится вне рабочей области, никакие углы суставов не работают.
- Сингулярности: В определённых позах две оси суставов выравниваются и робот теряет DOF: как блокировка подвеса. Рядом с сингулярностями небольшие декартовы движения требуют огромных скоростей суставов.
Обратная кинематика: почему это сложно?
Рассмотрим простой 2-звенной плоский манипулятор с L₁ = L₂ = 1 метр. Конечный рабочий орган должен достичь точку (1.0, 1.0).
Расстояние от основания до цели составляет sqrt(1² + 1²) = sqrt(2) ≈ 1.414 м. Поскольку L₁ + L₂ = 2 м > 1.414 м, точка достижима.
Форма достижимости
Рабочая область: геометрический объём, который может достичь робот
Рабочая область — это набор всех точек, которые конечный рабочий орган может достичь. Её форма полностью зависит от геометрии робота.
Шарнирный манипулятор (6-осевой): Рабочая область примерно сферическая. Внешняя граница находится на максимальном расстоянии (все звенья вытянуты). Внутренняя граница существует, потому что манипулятор не может складываться достаточно назад, чтобы достичь точки, слишком близкие к основанию. Поперечное сечение выглядит как бублик (тор).
SCARA: Рабочая область цилиндрическая. Манипулятор вращается горизонтально (создавая круговое поперечное сечение) и ось Z движется вертикально. Результат — плоский цилиндрический объём: широкий горизонтальный охват, ограниченный вертикально.
Декартов/портальный робот: Рабочая область прямоугольный куб. Каждая ось движется линейно вдоль одного направления. Просто, предсказуемо, легко программировать: но громоздко, потому что робот должен быть таким же большим, как его рабочая область.
Сингулярности в рабочей области: В определённых позах робот теряет DOF. Полностью вытянутый шарнирный манипулятор (на внешней границе своей рабочей области) находится в сингулярности: он не может переместить конечный рабочий орган дальше наружу. Сингулярности запястья возникают, когда две оси суставов запястья выравниваются. В сингулярности матрица Якобиана теряет ранг, и эффективный DOF робота временно уменьшается.
Ловкая рабочая область против достижимой рабочей области: Достижимая рабочая область — это место, где конечный рабочий орган может достичь в по крайней мере одной ориентации. Ловкая рабочая область — это место, где он может достичь любую произвольную ориентацию. Ловкая рабочая область всегда является подмножеством достижимой рабочей области: и часто намного меньше.
Выбор робота по рабочей области
Цех имеет три станции, расположенные в форме L. Станция A находится слева, станция B непосредственно впереди, станция C находится справа и немного выше (на 300 мм). Робот должен брать детали с A, выполнять операцию на B и размещать готовые детали на C: всё с одной позиции крепления.
Пространство конфигураций: абстрактная геометрия робота
Пространство конфигураций: место, где живит планирование движения
Пространство конфигураций (C-space) — одна из самых мощных геометрических абстракций в робототехнике. Вместо размышления о физической форме робота, представьте его полное состояние как одну точку в N-мерном пространстве.
Для робота с N суставами C-space имеет N измерений: одна ось на угол сустава. Каждая возможная поза робота — это одна точка в C-space. Движение (последовательность поз) — это кривая через C-space.
Препятствия в C-space: Физическое препятствие в реальном мире становится запрещённой областью в C-space. Если размещение робота под углами суставов (θ₁, θ₂, ..., θN) вызовет столкновение, эта точка находится внутри препятствия в C-space. Форма препятствий в C-space сложна: простой куб в реальном мире становится причудливо образной областью в C-space.
Планирование пути = поиск бесконфликтной кривой: Дана начальная конфигурация (точка в C-space) и целевая конфигурация (другая точка), найти непрерывную кривую, соединяющую их, которая не входит в какую-либо запрещённую область.
Алгоритмы:
- A* (на основе сетки): Дискретизировать C-space в сетку, поиск кратчайшего пути. Хорошо работает в низких размерностях (2-3 DOF), но размер сетки экспоненциально взрывается с размерностью.
- RRT (быстро исследующее случайное дерево): Построить дерево случайных выборок в C-space, растущее к неисследованным областям. Работает в высоких размерностях (6+ DOF). Не оптимально, но быстро находит допустимые пути.
- PRM (вероятностная дорожная карта): Предварительно вычислить график случайных бесконфликтных конфигураций, затем искать график. Хорошо для повторных запросов в одной среде.
Геометрическое понимание: проблема планирования пути 6-DOF робота — это проблема кривой-через-6D-пространство. Размерность делает точные решения неосуществимыми: вероятностные методы (RRT, PRM) — практический подход.
Мышление в пространстве конфигураций
2-звенной плоский манипулятор (2 DOF) работает в комнате с одним прямоугольным препятствием. Сустав 1 находится в диапазоне от 0° до 360°, сустав 2 находится в диапазоне от 0° до 360°. Пространство конфигураций — это 2D квадрат: θ₁ на одной оси, θ₂ на другой.