Головна Роботика та Кінематика Кінематика робота — пряма та зворотна кінематика

🦾 Кінематика робота — пряма та зворотна кінематика

Клацайте будь-де, щоб перемістити захват 3-ланкового робота через зворотну кінематику (транспонований якобіан). Обробляє сингулярності та обмеження суглобів.

Роботика та Кінематика3DСередній60 FPS
robot-kinematics ↗ Відкрити окремо
DRAG · SCROLL · CLICK — керуйте прямо у вікні симуляції.

Про цю симуляцію

Ця сторінка моделює плоску руку робота з трьома суглобами й розв'язує зворотну кінематику наживо, поки ви клацаєте: щокадру вона виконує метод транспонованого якобіана, зсуваючи кути суглобів θ₁, θ₂, θ₃ так, щоб захват збігався у вашій цільовій точці. Пряма кінематика будує позицію кожного суглоба з накопичених обертань ланок і фіксованої довжини ланки, тоді як демпфувальний член зупиняє розв'язувач від «вибуху» поблизу сингулярних, повністю витягнутих конфігурацій. Обмеження суглобів ±150° застосовуються на кожній ітерації, тож деякі цілі поблизу межі робочої зони просто недосяжні.

🔬 Що показано

3-ланкова рука, що переслідує клацнуту ціль за допомогою зворотної кінематики методом транспонованого якобіана, з живими кутами суглобів, похибкою позиції та кількістю ітерацій, а також пунктирним колом, що позначає зовнішню межу досяжної робочої зони.

🎮 Як користуватись

Клацніть або перетягуйте будь-де, щоб задати ціль. Повзунок α (0,05–2,0) задає розмір кроку зворотної кінематики, повзунок λ (0,0–1,0) задає демпфування сингулярності, а повзунок довжини ланки (60–160 пкс) одночасно змінює розмір усіх трьох рівних ланок. Кнопки Пауза, Скинути та Інфо розташовані нижче.

💡 Чи знали ви?

Метод транспонованого якобіана не потребує обернення матриці, тож він ніколи не може чисельно «вибухнути» — саме тому він є улюбленцем у режисурі ігор реального часу й анімації персонажів у реальному часі, а не лише в промисловій робототехніці.

Поширені запитання

Що таке пряма кінематика в робототехніці?

Пряма кінематика обчислює позицію захвату робота, виходячи з відомих кутів суглобів. Тут позиція кожного суглоба будується шляхом накопичення обертань θ₁, θ₂, θ₃ і кроку фіксованої довжини ланки в кожному отриманому напрямку, з'єднуючись від основи назовні.

Чому зворотна кінематика складніша за пряму?

Пряма кінематика має одну єдину відповідь для будь-якого набору кутів суглобів. Зворотна кінематика працює у зворотному напрямку від цільової позиції, і це відображення може мати багато дійсних розв'язків, жодного, якщо точка лежить поза робочою зоною, або стати нестабільним поблизу сингулярних поз руки.

Як метод транспонованого якобіана рухає руку?

Щокадру розв'язувач вимірює похибку між захватом і ціллю, будує матрицю Якобіана, що пов'язує рух суглобів з рухом захвату, і зсуває кути суглобів на крок, пропорційний транспонованому якобіану, помноженому на цю похибку, повторюючи, доки похибка не стане мізерною або не буде досягнуто ліміту ітерацій за кадр.

Що відбувається поблизу сингулярності?

Коли рука повністю витягнута або складена сама на себе, якобіан втрачає ранг, і звичайні кроки вимагали б неможливо великих швидкостей суглобів. Демпфувальний член, масштабований λ, зменшує ефективний розмір кроку в таких позах, тож рука плавно сповільнюється замість тремтіння.

Чому рука не завжди може досягти мого кліку?

Діють два обмеження: зовнішня межа робочої зони — коло радіусом, що дорівнює сумі трьох довжин ланок (кліки за його межами обмежуються всередину), і обмеження суглобів ±150°, які обмежують кожен кут після кожної ітерації і можуть залишити недосяжними навіть деякі внутрішні точки.

Схожі симуляції