Системы управления многозвенными механизмами тема диссертации и автореферата по ВАК РФ 05.13.01, кандидат технических наук Чепинский, Сергей Алексеевич

• Чепинский, Сергей Алексеевич
• кандидат технических наук
• 2006

Оглавление диссертации кандидат технических наук Чепинский, Сергей Алексеевич

ВВЕДЕНИЕ.

1. АНАЛИТИЧЕСКИЙ ОБЗОР И ОБЩАЯ ПОСТАНОВКА ЗАДАЧИ.

1.1 «Малоприводные» системы.

1.2 Перевернутый маятник с инерционным колесом.

1.3 Управляемый маятник Капицы.

1.4 Маятник Стефенсона-Капицы с внутренними степенями свободы.

1.5 Маятники Челомея.

1.6 Маятник Фуруты.

1.7 Задачи об управляемых движениях колебательных систем.

1.8 Общая постановка задачи.

1.9 Методы управления.

2. КОНСТРУКЦИИ ИССЛЕДУЕМЫХ МАЛОПРИВОДНЫХ МЕХАНИЗМОВ И ПОСТАНОВКА ЗАДАЧИ.

2.1 Анализ динамики и вывод математической модели перевернутого маятника на подвижной основе.

2.2 Анализ динамики и вывод математической модели робота-манипулятора с конечным бесприводным звеном.

2.3 Постановка задачи траекторного управления.

3. СИНТЕЗ АЛГОРИТМА УПРАВЛЕНИЯ ТРАЕКТОРНЫМ ДВИЖЕНИЕМ.

3.1 Общий подход к синтезу алгоритма управления траекторным движением.

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

4. АЛГОРИТМ УПРАВЛЕНИЯ ТРАЕКТОРНЫМ ДВИЖЕНИЕМ

МАЛОПРИВОДНЫХ МЕХАНИЗМОВ ВОКРУГ

ПРЯМОЛИНЕЙНОГО ОТРЕЗКА ПРЕДПИСАННОЙ КРИВОЙ.

4.1 Нормализованное представление прямолинейной траектории движения.

4.2 Траекторное управление перевернутым маятником на подвижной основе.

4.3 Траекторное управление двухзвенным роботом-манипулятором с конечным бесприводным звеном.

5 АЛГОРИТМ УПРАВЛЕНИЯ ТРАЕКТОРНЫМ ДВИЖЕНИЕМ

МАЛОПРИВОДНЫХ МЕХАНИЗМОВ ДЛЯ СЛУЧАЯ, КОГДА

ЖЕЛАЕМАЯ ТРАЕКТОРИЯ ЗАДАНА ОТРЕЗКОМ (ДУГОЙ)

ОКРУЖНОСТИ.

5.1 Нормализованное описание круговой траектории движения.

5.2 Траекторное управление перевернутым маятником на подвижной основе.

5.3 Траекторное управление двухзвенным роботом-манипулятором с конечным бесприводным звеном.

Введение диссертации (часть автореферата) на тему «Системы управления многозвенными механизмами»

Новые задачи управления сложными кинематическими механизмами обусловлены появлением робототехнических систем нетривиальной конструкции, к которым относятся роботы избыточной структуры, шагающие и многоколесные механизмы, маятнико-подобные и гироскопические системы. Наряду с задачами управления избыточными роботами [9, 18,30, 60], для которых число управляющих входов превышает степень свободы механизма, возникают проблемы стабилизации и управления пространственным движением механизмов, у которых количество входов меньше числа степеней свободы [46-51, 53, 55, 62-63], т.е. недостаточно для реализации обычных режимов работы робота -стабилизации, программного или траекторного управления. Тем не менее, несмотря на ограниченные функциональные возможности таких систем, они оказываются вполне пригодны для решения целого ряда специфических задач. К последним относятся задачи стабилизации положения неуправляемого конечного звена манипуляционного робота или робота нетривиальной конструкции (типа маятника на подвижной основе, например, маятника Фуруты, маятника Капицы, маятника Челомея), задачи стабилизации центра тяжести шагающего механизма [50, 53], стабилизации положения многоканальной гироскопической системы, а также соответствующие задачи поддержания их колебательных движений или траекторного управления. При этом уменьшение числа входов и, следовательно, исполнительных устройств (приводов) положительно сказывается на энергетических, массо-габаритных и стоимостных показателях.

Модели таких многоканальных объектов представлены ниже, в главах 1 и 2. В зарубежной литературе вышеприведенные механизмы называются Underactuated Systems, что в переводе на русский язык означает малоприводнные» системы. Изучению малоприводных механизмов и методам их управления посвящено много современных публикаций и научных докладов [46-55, 57-58, 62-63].

С точки зрения теории управления рассматриваемый класс механических объектов может быть отнесен к не полностью управляемым многоканальным многосвязным объектам, а соответствующие задачи управления — к задачам частичной стабилизации [12, 31, 60].

Целью диссертационной работы является исследование динамических свойств и анализ малоприводных механизмов с двумя степенями свободы. В качестве примера выбраны механизм с поступательно-вращательной кинематической парой (перевернутый маятник на тележке) и робот-манипулятор с двумя вращательными звеньями, конечное из которых неуправляемое (привод на звене отсутствует). А так же конечным результатом работы является синтез алгоритма траекторного управления, который включает в себя: анализ моделей малоприводных механизмов и их динамических свойств; отыскание задачно-ориентируемой модели в случае динамического описания малоприводного механизма; синтез общего алгоритма траекторного управления малоприводным механизмом для различных типов траекторий.

В диссертационной работе рассматривается задача управления траекторным движением кинематических механизмов с двумя степенями свободы (двухзвенных роботов) с одним управляющим входом. Конечным элементом кинематической цепи является бесприводное звено.

Анализируются проблемы управления движением многозвенных малоприводных роботов вдоль заданных гладких кривых (прямая, отрезок окружности), геометрия которых определяет как поступательное, так и вращательное движение конечного звена. Получены наиболее гибкие заданно-ориентированные решения проблем пространственного движения, связанные с линейными и угловыми отклонениями от требуемых соотношений, на основе методов нелинейной теории управления. Предлагается унифицированный подход основанный на методах согласованного управления (координации) [29]. Подход предусматривает формализацию задач движения в ограниченном пространстве в виде голономных соотношений, выходов системы и их исполнение за счет координации входных (управляющих) переменных. Использование вышеприведенного метода предполагает преобразование динамической модели малоприводного механизма в задачно-ориентированную форму, в которой динамика робота представлена в виде модели ортогональной ошибки отклонения конца конечного неуправляемого (бесприводного) звена от заданной в пространстве траектории движения. С использованием дифференциально-геометрических методов нелинейной теории управления [31, 56, 60] предложена методика анализа динамики таких систем и процедура синтеза алгоритмов управления, обеспечивающих решение траекторной задачи как задачи стабилизации относительно гладкого отрезка предписанной траектории.

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

Новизна научных решений.

Поставлена и решена качественно новая задача управления малоприводной системой — траекторная задача. В отличие от известных решений задач стабилизации относительно неустойчивого (опрокинутого) положения равновесия неуправляемого конечного звена робота [46-55, 5758, 62-63], решена задача стабилизации относительно гладкого отрезка предписанной траектории.

Получена новая задачно-ориентированная модель ортогональной ошибки отклонения от желаемой траектории движения в случае динамического описания многоканального механизма.

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

Практическая значимость.

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

Работа выполнена на Кафедре систем управления и информатики Санкт-Петербургского государственного университета информационных технологий, механики и оптики в рамках тематики работ лаборатории кибернетики и систем управления.

Работа выполнена при поддержке Российского фонда фундаментальных исследований (Грант 99-01-00761) и Комплексной программы 19 Президиума РАН (2001, раздел 1.4).

Апробация работы. доклад на XXXI научной и учебно-методической конференции профессорско-преподавательского состава СПГИТМО (ТУ) Санкт-Петербург 2002 г. (Мирошник И.В., Чепинский С.А. Управление многозвенними кинематическими механизмами [34]). th доклад на 9 International Student Olympiad on Automatic Control (Baltic Olympiad), St-Petersburg, 2002 (Chepinsky S.A. Trajectory control system for two-link underactuated mechanisms [51]). доклад на 7th IF AC Symposium on Robot Control. September 1-3, 2003, Wroclaw, Poland (Miroshnik I.V., Chepinsky S.A. Trajectory motion control of underactuated manipulators.[58]). доклад на ХХХШ научной и учебно-методической конференции профессорско-преподавательского состава СпбГУ ИТМО Санкт-Петербург 2004 г. (Мирошник И.В., Чепинский С.А. Траекторное управление кинематическими механизмами нетривиальной конструкции. [35]).

Публикации работы.

По материалам диссертации опубликовано 5 работ [34, 35, 51, 57, 58].

Структура и объем работы.

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

Заключение диссертации по теме «Системный анализ, управление и обработка информации (по отраслям)», Чепинский, Сергей Алексеевич

ЗАКЛЮЧЕНИЕ

Задачи управления колебательными малоприводными механическими системами имеют значительный теоретический интерес и возрастающее практическое значение. Для проведения научных исследований и учебного процесса в области мехатроники и систем автоматического управления разрабатывается лабораторное оборудование, методическое, алгоритмическое и программное обеспечение. Широкое распространение находят лабораторные маятниковые учебно-исследовательские комплексы. Наряду с наглядностью, маятниковые системы характеризуются существенно нелинейной динамикой, что позволяет изучать и демонстрировать достаточно сложные нелинейные эффекты, такие как неустойчивость, хаос, синхронизацию, и делает оправданным применение передовых подходов к управлению: методом функций Ляпунова и энергетических, адаптивных и согласованных, нейросетевых и нечетких систем [1-5, 31, 55, 62].

В диссертационной работе проведен анализ современного состояния развития малоприводных механизмов. Поставлена и решена качественно новая задача управления малоприводной системой — траекторная. В отличие от известных решений задач стабилизации относительно неустойчивого положения равновесия бесприводного конечного звена робота, решена задача стабилизации относительно гладкого отрезка предписанной траектории. Анализируются проблемы управления движением многозвенных роботов вдоль заданных гладких кривых (прямая, отрезок окружности). Дается нормализованное описание желаемых траекторий движения. Получены наиболее гибкие задачно-ориентированные решения проблем пространственного движения, связанные с линейными и угловыми отклонениями от требуемых соотношений, на основе дифференциально-геометрических методов нелинейной теории управления.

На защиту выносятся следующие положения диссертационной работы: общая схема анализа динамических свойств малоприводного механизма; задачно-ориентированная модель в случае динамического описания малоприводной системы; общий алгоритм управления траекторным движением, который позволяет устранить ортогональную ошибку отклонения от заданной траектории и обеспечить асимптотическую устойчивость; частный алгоритм траекторного управления движением двухзвенными малоприводными механизмами различной конструкции (перевернутый маятник на подвижной основе, двухзвенный робот-манипулятор с неуправляемым звеном) для различных типов желаемых траекторий. Дальнейшее развитие представленного в диссертационной работе подхода, по мнению автора, должно состоять: в управлении траекторным движением многоканальными малоприводными механизмами относительно более сложных кривых; в построении ограниченного управления; в определении возможности синтеза алгоритма управления для неограниченного малоприводного объекта управления.

Список литературы диссертационного исследования кандидат технических наук Чепинский, Сергей Алексеевич, 2006 год

1. Андриевский Б.Р. Фрадков А.Л. Избранные главы теории автоматического управления с примерами на языке MATLAB. СПб.: Наука, 1999.-467 с.

2. Андриевский Б.Р. Фрадков А.Л. Управление хаосом: методы и приложения. Часть 1. Методы // АиТ. 2003, №5. С. 3-45.

3. Андриевский Б.Р. Фрадков А.Л. Управление хаосом: методы и приложения. Часть 2. Приложения // АиТ. 2004, №4. С. 1-37.

4. Андриевский Б.Р., Блехман И.И., Борцов Ю.А. Управление мехатронными вибрационными установками. СПб. Наука, 2001. 227 с.

5. Андриевский Б.Р., Гузенко П.Ю., Фрадков А.Л. Управление нелинейными колебаниями механических систем методом скоростного градиента. // Автоматика и Телемеханика, №4 1996. С. 4-17.

6. Бесекерский В.А., Попов Е.П. Теория систем автоматического регулирования. Москва: Наука, 1972. 768 с.

7. Богомолов В.П., Кулаков Ф.М. Информационно-управляющие системы нетрадиционно используемых роботов. Изв. РАН: Теория и системы управления. №4, 1999. С. 8-14.

8. Болотник Н. Н., Стернин С. Л. Оптимизация движений универсального многозвенного шагающего робота. Изв. РАН: Теория и системы управления. №4, 1997. С 18-23.

9. Бурдаков С.Ф., Мирошник И.В., Стельмаков Р.Э. Системы управления движением колесных роботов, Наука, Санкт-Петербург, 2001. — 227с.

10. Васильев С.Н. От классических задач регулирования к интеллектуальному управлению. I // Известия РАН Теория и системы управления. 2001. №1. С. 5-22.

11. Васильев С.Н. От классических задач регулирования к интеллектуальному управлению. II // Известия РАН Теория и системы управления. 2001. №2. С. 5-21.

12. Воротников В.И. Задачи и методы исследования устойчивости и стабилизации движения по отношению к части переменных: направления исследования, результаты, особенности // Автоматика и телемеханика, 1993, N 3. С.25-32.

13. Вукобратович М., Стоич Д., Управление манипуляционными роботами: теория и приложения. М.: Главная редакция физико математической литературы, 1985. - 384 с.

14. Гришин А. А., Житомирский С. В., Ленский А. В., Формальский А. М. Управление ходьбой двуногого пятизвенного механизма. Изв. РАН: Теория и системы управления. №6, 1999. С. 15-19.

15. Гультяев А.К. MATLAB 5.2 Иммитационное моделирование в среде Windows: Практическое пособие. СПБ.: КОРОНА принт, 1999. - 288 с.

16. Егоренков Д.Л., Фрадков А.Л., Харламов В.Ю. Основы математического моделирования с примерами на языке MATLAB. Изд. 2-е, доп.: Учебное пособие. Под ред. д-ра техн. наук Фрадкова А.Л. БГТУ. СПб. 1996. 192 с

17. Елкин В.И. Редукция нелинйных управляемых систем: Дифференциально-геометрический подход. — М.: Наука. Физматлит, 1997. -320 с.

18. Зенкевич С.Л., Ющенко А.С. Управление роботами. Основы управления манипуляционными роботами. М.: МГТУ им. Н.Э. Баумана, 2000. 400 с.

19. Зубов В.И. Динамика управляемых систем: Учебное пособие для вузов по специальности «Прикладная математика». — М.: Высшая школа, 1982. -285 с.

20. Капица П.Л. Динамическая устойчивость маятника при колеблющейся точке подвеса // ЖЭТФ. 1951. Т21. N5

21. Квакернаак X., Сиван Р. Линейные оптимальные системы управления. М.: Мир, 1977.-464 с.

22. Кобринский А.А., Кобринский А.Е. Манипуляционные системы роботов: основы устройства, элементы теории. М.: Наука. Главная редакция физико-математической литературы, 1985. 344 с.

23. Колесников А.А. Основы теории синергетического управления. М.: Фирма «Испо-Сервис», 2000. 264 с.

24. Корн Г., Корн Т. Справочник по математике. Для научных работников и инженеров. М.: Наука. Физматлит, 1978. - 832 с.

25. Кумакшев С.А. Определение управляющих моментов, обеспечивающих равновесие восьминогого шагающего аппарата в цилиндрической трубе. Изв. РАН: Теория и системы управления. №3, 2000. С. 19-24.

26. Лернер А.Я., Розенман Е.А. Оптимальное управление. М.: Энергия. 1970. 360 с.

27. Лурье А.И. Аналитическая механика. М.: Физматгиз, 1961. 824 с.

28. Медведев B.C., Лесков А.Г., Ющенко А.С. Системы управления манипуляционных роботов. М.: Наука, 1978.-416 с.

29. Мирошник И.В. Согласованное управление многоканальными системами. Энергоатомиздат, 1990. 128 с.

30. Мирошник И.В., Никифоров В.О., Шиегин В.В. Управление движением кинематически избыточных манипуляционных роботов // Изв. РАН: Теория и системы управления. №1, 2001 С. 31-42.

31. Мирошник И.В., Фрадков А.Л., Никифоров В.О. Нелинейное и адаптивное управление сложными динамическими системами. Санкт-Петербург: Наука, 2000. 549 с.

32. Мирошник И.В. Теория автоматического управления. Линейные системы. СПб.: Питер, 2005. 336 с.

33. Мирошник И.В. Нелинейные системы. Анализ и управление. -СПб.:СПбГИТМО(ТУ), 2002. 169 с.

34. Мирошник И.В., Чепинский С.А. Управление многозвенными кинематическими механизмами. Научно-технический вестник СПбГИТМО (ТУ), вып. 3. Физические процессы, системы и технологии точной механики //В.Н. Васильев. СПбГИТМО (ТУ), 2002, С. 144-149.

35. Накано Э. Введение в робототехнику. Пер. с япон. М.: Мир, 1988.344 с.

36. Потемкин В.Г. Система MATLAB. Справочное пособие. М.: ДИАЛОГ-МИФИ, 1997.-350 с.

37. Потемкин В.Г. Система инженерных и научных расчетов MATLAB 5.x: -В 2-х т. М.: ДИАЛОГ-МИФИ, 1999. - Т. 1-2.

38. Сучков А. И. Вибраторный динамически настраиваемый гироскоп как измеритель для построения малогабаритных бесплатформенных инерциальных навигационных систем. Изв. РАН: Теория и системы управления. №6, 1997. С. 5-9.

39. Управление в физико-технических системах. // Под ред. Фрадкова А.Л. -СПб.: Наука, 2004. 272 с. (Серия «Анализ и синтез нелинейных систем»)

40. Фрадков А.Л. Кибернетическая физика. Наука, 2003. 272 с.

41. Фрадков А.Л., Шиегин В.В., Стабилизация энергии колебаний с применением к маятнику с управляемой точкой подвеса. // Изв. АН. Теория и системы управления. №2, 1999. С. 19-24.

42. Черноусько Ф.Л., Акуленко Л.Д., Соколов Б.Н. Управление колебаниями. М.: Наука, 1980.

43. Черноусько Ф.Л., Болотник Н.Н., Градецкий В.Г. Манипуляционные роботы: динамика, управление, оптимизация. М.: Наука, 1989.

44. Черноусько Ф.Л. Декомпозиция и субоптимальное управление в динамических системах. // ПММ. Т. 54 Вып. 6. 1990.

45. Aracil J., Gordillo F., Acosta J.A. Stabilization of oscillations in the inverted pendulum. // 15 IF AC World congress. Barselona. 2002. pp. 33-38.

46. Acosta J.A., Ortega R., Astolfi A. Position-feedback stabilization of mechanical systems with underactuation degree one. // 6 IFAC Symposium on Nonlinear Control. Germany. 2004. pp. 41-46.

47. Acosta J.A., Gomez-Estern F., Van der Schaft. Passivation of underactuated systems with physical damping. // 6 IF AC Symposium on Nonlinear Control. Germany. 2004. pp. 72-77.

48. Antonio Pedro Aguiar, Antonio M. Pascoal. Dynamic positioning auv in the presence of a constant unknown ocean disturbance. // 15 IF AC World congress. Barselona. 2002. pp.80-85.

49. Chevallereau C. Parameterised control for an underactuated biped robot. // 15 IFAC World congress. Barselona. 2002. pp. 124-129.

50. Chepinsky S.A. Trajectory control system for two-link underactuated mechanisms. PREPRINTS 9th International Student Olympiad on Automatic Control (Baltic Olympiad) St-Petersburg, 2002. pp. 15-19.

51. Furuta K. Super mechano-systems: fusion of control and mechanism. // 15 IFAC World congress. Barselona. 2002. pp 63-69.

52. Espiau В., Canudas de Wit C., Urrea C. Orbital Stabilization of underactuated mechanical systems, 15 IFAC World Congress. Barselona, 2002. pp. 77-83.

53. Euntai Kim, Changwoo Rark A Study on the Self-excited Oscillation of a Fazzy Control Sistem-Static Case. Proceedings of the 2nd Asian Control Conference, July 22-25, 1997, Seoul, pp. 127-133.

54. Hideki Saito, Hideki Fujifawa Stabilization of a Double Inverted Pendulum by Fazzy Control. Proceedings of the 2nd Asian Control Conference, July 22-25, 1997, Seoul, pp. 71-76.

55. Isidori A. Nonlinear control systems. 3d edition. NY: Springer-Verlag, 1995.

56. Miroshnik I.V., Chepinsky S.A. Trajectory control of underactuated mechanisms. 2nd IFAC Conference on Mechatronic Systems. Berkley, 2002. pp. 46-51.

57. Miroshnik I.V., Chepinsky S.A. Trajectory motion control of underactuated manipulators. PREPRINTS 7th IFAC Symposium on Robot Control. September 1-3, 2003, Wroclaw, Poland, pp. 78-82.

58. Miroshnik I.V. Attractors and partial stability of nonlinear dynamical systems. // 5 th IF AC Symposium on Nonlinear Control Systems (NOLCOS'Ol). Preprints, vol. 3. St. Petersburg, 2001, pp. 848-853.

59. Miroshnik I.V. and V.O. Nikiforov. Trajectory motion control and coordination of multilink robots. Prepr. 13th IF AC World Congress, San-Francisco, vol.A, 1996 pp.361-366.

60. Murray R.M., Zexiang I.L. and Sastry S.S.A Mathematical Introduction to Robotic Manipulation. Boca Raton: CRC Press, 1993.

61. S. K. Tso, Y. H. Fung Fazzy Implementation of Real-time Control of Inverted Pendulum. Proceedings of the 2nd Asian Control Conference, July 22-25, 1997, Seoul, pp. 105-111.

62. Yabuno H. Motion control of an underactuated two-link manipulator by using high-frequency excitation. // IEEE International Conference Physics and Control. Russia. 2005. pp. 407-412.