Синтез алгоритма интерполяции отрезка прямой для планирования траектории движения вырожденного двухзвенного механизма

Управление технологическими устройствами на базе вырожденного двухзвенного механизма. Расчет параметров интерполяционного шага микроконтроллера. Синтез алгоритма интерполяции отрезка прямой для планирования траектории движения двухзвенного механизма.

Рубрика Программирование, компьютеры и кибернетика
Вид статья
Язык русский
Дата добавления 30.05.2017
Размер файла 200,4 K

Отправить свою хорошую работу в базу знаний просто. Используйте форму, расположенную ниже

Студенты, аспиранты, молодые ученые, использующие базу знаний в своей учебе и работе, будут вам очень благодарны.

Размещено на http: //www. allbest. ru/

Синтез алгоритма интерполяции отрезка прямой для планирования траектории движения вырожденного двухзвенного механизма

О.А. Горлин, Ю.А. Дугин, С.В. Подоров,

Д.В. Скрипкин, И.И. Наумов

В работе [1] описана кинематическая схема устройства на базе двухзвенного механизма, показаны её преимущества при механической технологической обработке ряда материалов и области возможного применения.

Механизм состоит из круга и сегмента круга одинакового радиуса, являющихся первым и вторым звеном устройства (рис. 1). Круг вращается относительно вертикальной оси, расположенной в начале основной системы координат (точка O на рис. 1). Сегмент закреплён с возможностью вращения в начале дополнительной системы координат (точка O' на рис. 1), расположенной на краю круга.

На рис. 1 приняты следующие обозначения:

- угол поворота круга относительно основной системы координат;

- угол поворота штанги относительно дополнительной системы координат;

a,b - точки концов отрезка ab;

R - радиус звеньев;

- точки концов отрезка ab в полярной системе координат соответственно;

- угол текущего положения рабочего инструмента в полярной системе координат.

Рис. 1 Кинематическая схема устройства

Общую постановку задачи интерполяции отрезка прямой можно сформулировать в следующем виде: на основании известных на каждом шаге приращений линейных координат Дx и Дy (x = 0,±1;y = x = 0,±1) определяются приращения угловых координат звеньев механизма и .

Значения единичных угловых приращений и являются конструктивными постоянными механизма. Линейные единичные приращения и (шаг линейной интерполяции) выбираются исходя из желаемой точности линейной интерполяции и значений и в соответствии с правилами, изложенными в [2].

На Рис. 1 показано состояние механизма, когда начальная точка отрезка прямой и текущее положение рабочего инструмента (конец радиуса вектора ) совпадают. Известны: текущее положение угловых и линейных координат, а также координат начала второго звена x1, y1 в системе координат, связанной с осью вращения первого звена.

Последовательность операций на один вычислительный цикл шага интерполяции может быть представлена в следующем виде:

- определение линейных координат очередной точки отрезка методами линейной интерполяции;

- определение направления и величины перемещения по угловой координате ;

- определение величины и направления приращения по координате ;

- реализация перемещений в режиме реального времени;

- переход к очередному шагу интерполяции.

Процедура линейной интерполяции достаточно просто может быть реализована на основании алгоритма Брезенхейма, применяющегося при построении линий средствами растровой графики (используется для мониторов ПК).

Для определения приращения по угловой координате перейдем к полярной системе координат, центр которой совмещен с центром основной декартовой системы координат xy, а полярная ось направлена по оси x декартовой системы, определим в этой системе координаты положения очередной точки исходя из соотношений:

(1)

Отсюда полное приращение по угловой координате будет равно:

(2)

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

(3)

Здесь - число шагов единичного перемещения по угловой координате на текущем шаге интерполяции, определяемое как целая часть частного от деления .

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

Рис. 2 Геометрическое представление приращения угловых координат

На рис. 2 приведена геометрическая интерпретация процедуры расчета приращения угловой координаты . Здесь показано положение звеньев механизма на i-том и i+1 -ом шаге интерполяции. Положения начала второго звена на i-том и i+1 -ом шаге интерполяции обозначены на рисунке как точки A и A'. Положения конечной точки второго звена (инструмента) для этих случаев обозначены как B и B' соответственно. Таким образом, абсолютное значение угловой координаты в системе координат X'OY' (рис. 1) на i+1 шаге интерполяции может быть определено исходя из геометрических параметров треугольника OA'B', три стороны и один угол которого известны по результатам предыдущего этапа расчета параметров очередного шага интерполяции. Используя известную теорему синусов для треугольника OA'B' можно записать в виде:

(4)

Здесь .

Значение угловой координаты соответственно равно:

(5)

По аналогии с определением числа элементарных угловых приращений по координате число элементарных угловых перемещений по координате можно определить как целую часть выражения:

(6)

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

Предложенный алгоритм интерполяции был реализован в виде программного кода на языке С++ в среде Borland. Тестирование программы показало полную работоспособность алгоритма. Методика интерполяции, предложенная в данной работе, была опробована на опытном образце устройства. В качестве вычислителя был использован микроконтроллер STM32F107 с ядром Cortex M3, которое поддерживает арифметику с плавающей точкой. Опытным путем было установлено, что время расчета параметров одного интерполяционного шага составляет 20 мкс, что существенно меньше временного шага интерполяции, рассчитанного исходя из требуемой технологической скорости перемещения рабочего инструмента 2 м/мин и линейном шаге интерполяции Дx = Дy = 0,05 мм.

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

Работа выполнена в рамках федеральной целевой программы ФЦП "Научные и научно-педагогические кадры инновационной России" на 2009-2013 годы

двухзвенный интерполяция траектория алгоритм

Литература

1 Манипулятор [Текст]: пат. 2399478 Российская Федерация, МПК В25J11/00 / Валюкевич Ю.А., Наумов И.И., Алепко А.В., заявитель и патентообладатель ГОУ ВПО «ЮРГУЭС». - № 2008152518/02, заявл. 29.12.2008; опубл. 20.09.2010, Бюл. № 26.

2 Валюкевич Ю.А., Наумов И.И. Устройство обработки плоских материалов на базе двухзвенного механизма [Текст]// Научно-технические ведомости Санкт-Петербургского государственного политехнического университета, 2010. - № 95. - С.177-181.

Размещено на Аllbеst.ru


Подобные документы

  • Динамическая и математическая модели движения иглы в замке вязального механизма. Форма заключающего клина. Синтез закона движения иглы. Упрощенное изображение вязального механизма однофонтурной вязальной машины. Математическое моделирование движения иглы.

    курсовая работа [1,5 M], добавлен 03.03.2015

  • Проект оболочки моделирования кривошипно-шатунного механизма в среде MS Visual Studio. Разработка его математической модели. Исследование кинематики точек В, С, М. Алгоритм и код программы. Анимация движения механизма и график движения основных точек.

    курсовая работа [422,2 K], добавлен 13.03.2016

  • Общие требования к изображению отрезка с помощью цифрового дифференциального анализатора. Сравнительный анализ обычного и несимметричного алгоритмов и алгоритма Брезенхема для генерации векторов (соединения двух точек изображения отрезком прямой).

    презентация [65,3 K], добавлен 14.08.2013

  • Разработка программы, моделирующей работу сложного механизма, состоящего из двух кривошипов, шатунов и ползуна, в среде Delphi 7. Описание алгоритма работы программы и расчет ускорения точек механизма. Обзор уравнения сложности и руководства пользователя.

    курсовая работа [143,3 K], добавлен 07.08.2013

  • Кинематическое исследование механизма манипулятора, особенности управления. Определение необходимых перемещений звеньев, траектории, скоростей и ускорений. Траектория движения захвата, график пути первого звена. Программа, её содержание и текст.

    курсовая работа [343,1 K], добавлен 19.12.2011

  • Моделирование траектории движения космического аппарата, запускаемого с борта космической станции, относительно Земли. Запуск осуществляется в направлении, противоположном движению станции, по касательной к её орбите. Текст программы в среде Matlab.

    контрольная работа [138,8 K], добавлен 31.05.2010

  • Понятие и характеристика некоторых методов интерполяции. Вычисление значения функции между заданными точками несколькими методами. Алгоритм линейной интерполяции. Алгоритм локальной интерполяции по формуле Лагранже. Инструкция пользования программой.

    курсовая работа [186,5 K], добавлен 30.05.2015

  • Разработка и написание программы по моделированию движения снаряда при заданных параметрах пути, максимальной высоты, времени полета и траектории. Анализ методов построения модели, разработка алгоритма, написание и отладка программы в среде Delphi.

    курсовая работа [214,5 K], добавлен 11.02.2011

  • Принцип работы алгоритма бинарного поиска в массиве. Способы исследования алгоритма "прямое включение". Формулы зависимости числа сравнений от элементов в массиве. Графики среднего числа сравнений и перемещений практических и теоретических измерений.

    курсовая работа [646,1 K], добавлен 07.01.2014

  • Разработка алгоритма фильтрации данных, полученных с систем спутниковой навигации с помощью GNSS-модуля. Анализ работы фильтра Калмана, его программная реализация под конкретную задачу. Выбор навигационных модулей для получения данных позиционирования.

    дипломная работа [3,6 M], добавлен 12.01.2016

Работы в архивах красиво оформлены согласно требованиям ВУЗов и содержат рисунки, диаграммы, формулы и т.д.
PPT, PPTX и PDF-файлы представлены только в архивах.
Рекомендуем скачать работу.