Добавил:
Upload Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:
Лекц_5_MM.doc
Скачиваний:
0
Добавлен:
01.04.2025
Размер:
890 Кб
Скачать
☆

3.4.Метод «жёсткого» программирования

Робототехника представляет собой благоприятное поле для использования методов иерархического моделирования. Рассмотрим упрощенную модель робота (рис.17.5)

Рис.5.5 Представление фигурки робота в виде дерева

Изображение отдельных компонент робота в собственных системах координат формируется в нескольких функциях. Далее формируется набор описаний узлов дерева в которых определяются матрицы преобразования символа с которым связан узел, относительно символа родительского узла. Например, рассмотрим руку робота (рис.17.6). Механизм имеет три степени свободы, каждая из которых описывается углом поворота в сочленении. Угол определяет, как будет располагаться следующее звено относительно предыдущего. Чтобы реализовать динамическое изображение движущегося робота, необходимо пользоваться подходом, основанным на суперпозиции движения отдельных звеньев. Тело робота может поворачиваться вокруг оси y собственного фрейма на угол . Следовательно, можно описать перемещение любой точки p на теле робота, воспользовавшись матрицей преобразования поворота .

Рис. 5.6. Перемещение звеньев робота и связанных с ним фреймов

Плечо робота поворачивается вокруг оси z собственного фрейма, но этот фрейм нужно привязать к центру верхней плоскости тела робота. Это можно сделать с помощью матрицы преобразования Т(0, h, 0), где h – высота тела относительно плоскости основания. Именно в этой точке находится сочленение между первым и вторым звеньями. Но если поворачивать тело робота, то вместе с ним поворачивается и плечо, точнее фрейм плеча. Следовательно, в дополнении к преобразованию сдвига нужно применить и преобразование поворота, воспользовавшись матрицей . Таким образом, положение любой точки на втором звене, в том числе и вершин многогранника, представляющего параллелепипед, в процессе изменения углов в первом и втором сочленениях будет зависеть от произведения матриц . Матрицу можно рассматривать как матрицу преобразования фрейма плеча относительно мирового фрейма, а матрицу как матрицу положения плеча относительно тела робота.

Рассуждая аналогично в отношении предплечья, приходим к выводу, что положение точек предплечья (вершин представляющий это звено пораллелепипеда) определяется произведением: . Функция отображения в OpenGL-программе построена таким образом, что матрица вида изменяется перед формированием изображения каждого очередного звена.

Код программы:

glRotetef(theta, 0.0, 1.0, 0.0);

base();

glTranslatef(0.0, h1, 0.0);

glRotetef(phi, 0.0, 0.0, 1.0);

lower_arm();

glTranslatef(0.0, h2, 0.0);

glRotetef(psi, 0.0, 0.0, 1.0);

upper_arm();

Изменив функции формирования объектов можно изменить внешний вид робота. Такое разделение позволяет отдельно описывать движение робота и форму звеньев.

В структуру узла можно включить информацию о цвете, свойствах материала, освещении, всё то, что называется набор атрибутов.

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

Функцию обхода дерева можно запрограммировать двумя способами:

  1. используя стек для хранения матриц и атрибутов

  2. используя рекурсивную процедуру.

Соседние файлы в предмете [НЕСОРТИРОВАННОЕ]