Синтез управляющего автомата модели LEGO транспортной тележки и моделирование ее движения
В исходном состоянии тележка непрерывно движется под действием привода. Ни один из датчиков контраста не находится над белой полосой трассы. Поворотный двигатель остановлен; При возникновении белой полосы под левым датчиком контраста включается поворотный двигатель на отработку влево. Привод отключается и далее следует движение по инерции, что уменьшает вероятность заноса тележки; Как только… Читать ещё >
Синтез управляющего автомата модели LEGO транспортной тележки и моделирование ее движения (реферат, курсовая, диплом, контрольная)
смотреть на рефераты похожие на «Синтез управляющего автомата модели LEGO транспортной тележки и моделирование ее движения «.
Кубанский государственный технологический университет.
Кафедра автоматизации технологических процессов.
Задание на контрольную работу.
По дисциплине «Автоматизированное управление дискретными процессами» для студентов заочной формы обучения специальности 21.01 — «Автоматика и управление в технических системах» на тему: «Синтез управляющего автомата модели LEGO — „транспортная тележка“ и моделирование её движения вдоль трассы».
Выдано:
Аспирантом каф. АПП 06.09.99 /Напылов Р.Н./.
студенту гр. ____________ /____________/.
Краснодар 1999.
Исходные данные.
1 Управляемый процесс — движение модели LEGO транспортной тележки вдоль заданной траектории в виде белой полосы. Ориентация тележки относительно трассы регулируется датчиками контраста.
2 Условная схема транспортной тележки приводится на рисунке 1.1. Тележка движется за счёт заднего привода, создающего постоянное тягловое усилие [pic]. Вращение переднего колеса тележки осуществляется с помощью реверсивного поворотного двигателя, отрабатывающего с постоянной угловой скоростью [pic], где [pic] — угол поворота переднего колеса (рисунок 1.1).
3 Транспортная тележка, как объект управления имеет систему дискретных входных и выходных сигналов, структурно представленную на рисунке 1.2. Кодировка указанных сигналов следующая:
Таблица 1.1 — Кодировка управляющих сигналов.
|Разряд | | |сигнала |Управляющее действие | |X | | |X0 |1 — двигатель тележки включен | | |0 — двигатель тележки выключен | |X1 |1 — поворотный двигатель отрабатывает влево | | |0 — двигатель влево не отрабатывает | |X2 |1 — поворотный двигатель отрабатывает вправо | | |0 — двигатель вправо не отрабатывает |.
Таблица 1.2 — Кодировка выходных сигналов.
|Разряд | | |сигнала |Событие | |Y | | |Y0 |1 — левый датчик над светлой точкой трассы | | |0 — левый датчик над тёмной точкой трассы | |Y1 |1 — правый датчик над светлой точкой трассы | | |0 — правый датчик над тёмной точкой трассы |.
Сигналы Y используются в качестве обратной связи управляющего автомата. По изменению этих сигналов возможно судить о текущем положении тележки относительно белой полосы трассы. Сигналы X вырабатываются управляющим автоматом в зависимости от поведения во времени сигналов Y так, что бы обеспечить совпадение траекторий движения тележки и трассы.
4 Решение о подачи питания на задний привод тележки и, расположенный на ней, управляющий автомат принимает внешний оператор. Поэтому, исходным состоянием тележки является активность двигателя привода. В этом случае задача управляющего автомата состоит только в обеспечении движения тележки вдоль трассы.
5 Допущения, делаемые при рассмотрении управляемой тележки в динамике:
тягловое усилие [pic] постоянное; приведённая сила трения [pic] пропорциональна линейной скорости движения тележки; сила трения [pic], подменяющая реакцию [pic] в момент, когда [pic] (переднее колесо проскальзывает), постоянна и пропорциональна массе тележки; сила трения [pic], подменяющая реакцию [pic] в момент, когда [pic] (тележку заносит), также постоянна и пропорциональна массе тележки; масса тележки [pic] и её момент инерции [pic] относительно центра масс связаны зависимостью: [pic], как если бы вся масса тележки была сосредоточена в стержне [pic] (рисунок 1.1).
Основное задание.
1 Сформировать модель управляющего автомата в форме таблицы переходов и выходов автомата Милли, предварительно составив список его возможных состояний и перекодировав входной алфавит автомата во множество многозначной логики (Y — четырёхзначное);
2 Минимизировать, в случае возможности, таблицу переходов и выходов автомата Милли;
3 Составить алгебрологические выражения функции переходов и функции выходов минимизированного автомата, используя только двоичное представление входных и выходных сигналов;
4 Минимизировать полученные функции;
5 По минимизированным логическим функциям зарисовать цифровую схему управляющего автомата (стандарт условного графического изображения логических элементов — Российский).
Дополнительное задание.
Вывести модель динамики транспортной тележки. Положение центра масс тележки в плоской системе координат задавать вектором положения [pic]. Положение точки приложения силы тяги привода задавать вектором [pic].
Список источников.
1 Юдицкий С. А., Магергут В. Э. Логическое управление дискретными процессами.
Модели, анализ, синтез. — М.: Машиностроение, 1987. — 176 c.
2 Кузнецов О. П., Адельсон-Вольский Г. М. Дискретная математика для инженеров. — М.: Энергоатомиздат, 1987. — 450 c.
3 Шварце Х., Хольцгрефе Г.-В. Использование компьютеров в регулировании и управлении: Пер. с нем.—М.: Энергоатомиздат, 1990. — 176 с.: ил.
4 Каган Б. М., Сташин В. В. Основы проектирования микропроцессорных устройств автоматики. — М.: Энергоатомиздат, 1987. — 304 c.
5 Мишель Ж., Лоржо К., Эспью Б., Программируемые контроллеры. — Пер. c французского А. П. Сизова — М.: Машиностроение, 1986.
6 Микропроцессоры: В 3-х кн. Кн. 2. Средства сопряжения. Контролирующее и информационно-управляющие системы: Учеб. Для втузов/В.Д. Вернер, Н. В. Воробьёв, А. В. Горячев и др.; Под ред. Л. Н. Преснухина. — М.: Высш. шк., 1986. — 383 c.: ил.
7 Фиртич В. Применение микропроцессоров в системах управления: Пер. с нем. — М.: Мир, 1984,—464 c., ил.
Решение основного задания.
1 Выходной алфавит транспортной тележки является входным алфавитом управляющего автомата Y. Для возможности применения теории конечных автоматов перекодируем его во множество четырёх знаков в соответствии с таблицей 5.1.
Таблица 5.1 — Кодировка входного алфавита управляющего автомата.
|Y0 |Y1 |Y | |0 |0 |0 | |0 |1 |1 | |1 |0 |2 | |1 |1 |3 |.
2 При определении возможных состояний управляющего автомата будем руководствоваться правилом: — допустимо введение избыточных состояний, которые при последующей минимизации автомата исключаются; недопустим пропуск необходимого состояния, который уменьшает адаптированность автомата к внешним ситуациям.
Перечень возможных состояний автомата, отождествлённых с ситуационными событиями транспортной тележки, приводится ниже.
Таблица 5.2 — Перечень состояний управляющего автомата транспортной тележки.
|Код |Описание состояния | |состояния S | | |0 |Исходное состояние неуправляемого движения; | |1 |Поворот вправо (поворотный двигатель непрерывно | | |отрабатывает вправо); | |2 |Поворот влево (поворотный двигатель непрерывно | | |отрабатывает влево); | |3 |Конфликт поворотов. |.
3 Для возможности формирования математической модели управляющего автомата рассмотрим описательный алгоритм управления транспортной тележки по состояниям:
В исходном состоянии тележка непрерывно движется под действием привода. Ни один из датчиков контраста не находится над белой полосой трассы. Поворотный двигатель остановлен; При возникновении белой полосы под левым датчиком контраста включается поворотный двигатель на отработку влево. Привод отключается и далее следует движение по инерции, что уменьшает вероятность заноса тележки; Как только левый датчик контраста «сходит» с белой полосы поворотный двигатель останавливается в текущем состоянии, а привод вновь запускается; При возникновении белой полосы под правым датчиком — поведение транспортной тележки аналогично; Возникновение белой полосы под правым и левым датчиком свидетельствует о том, что тележка движется перпендикулярно трассе. Это сбойная ситуация, при которой следует отключение привода и блокировка управляющего автомата. Нормальный ход работы автомата может быть восстановлен только «сбросом».
4 Поскольку управляющий сигнал имеет три разряда, то для составления модели автомата Милли необходимо построить три таблицы переходов и выходов. Указанные таблицы, эквивалентные описательному алгоритму управления, приводятся ниже.
Таблица 5.3 — Таблицы переходов и выходов управляющего автомата.
| |Для X0 |Для X1 |Для X2 | |Код | | | | |Si | | | | | |y |y |y | | |0 |1 |2 |3 |0 |1 |2 |3 |0 |1 |2 |3 | |0 |[pic|[pic|[pic|[pi|[pic|[pic|[pic|[pic|[pic|[pi|[pi|[pi| | |] |] |] |c] |] |] |] |] |] |c] |c] |c] |.
| |Для X0 |Для X1 |Для X2 | |Код | | | | |Si | | | | | |y |y |y | | |0 |1 |2 |3 |0 |1 |2 |3 |0 |1 |2 |3 | |1 |[pic|[pic|[pic|[pi|[pic|[pic|[pic|[pic|[pic|[pi|[pi|[pi| | |] |] |] |c] |] |] |] |] |] |c] |c] |c] | |2 |[pic|[pic|[pic|[pi|[pic|[pic|[pic|[pic|[pic|[pi|[pi|[pi| | |] |] |] |c] |] |] |] |] |] |c] |c] |c] | |3 |[pic|[pic|[pic|[pi|[pic|[pic|[pic|[pic|[pic|[pi|[pi|[pi| | |] |] |] |c] |] |] |] |] |] |c] |c] |c] |.
5 Как видно, состояния S0, S1, S2 явно эквивалентны, причём для каждого из выходов X. Представляется возможным эти эквивалентные состояния обозначить одним состоянием S0 — состояние управления тележкой. В этом случае, состояние блокировки S3 удобно переобозначить как S1 — состояние блокировки автомата. В результате получаем модель несократимого автомата Милли.
Таблица 5.4 — Таблицы переходов и выходов несократимого автомата.
| |Для X0 |Для X1 |Для X2 | |Код | | | | |Si | | | | | |y |y |y | | |0 |1 |2 |3 |0 |1 |2 |3 |0 |1 |2 |3 | |0 |[pic|[pic|[pic|[pi|[pic|[pic|[pic|[pic|[pic|[pi|[pi|[pi| | |] |] |] |c] |] |] |] |] |] |c] |c] |c] | |1 |[pic|[pic|[pic|[pi|[pic|[pic|[pic|[pic|[pic|[pi|[pi|[pi| | |] |] |] |c] |] |] |] |] |] |c] |c] |c] |.
6 Учитывая, что код состояния полученной модели описывается одноразрядным сигналом S, а также учитывая кодировку входных сигналов Y (табл. 5.1), составим таблицу истинности комбинационной схемы автомата, непосредственно по таблице 5.4 и введя обозначения: S[j] — текущий сигнал состояния, S[j+1] — сигнал состояний на следующем такте автомата.
Судя по таблице 5.5, минимизации поддаётся только функция переходов [pic]. Минимизируем её методом карт Карно (см. рис. 5.1).
Таблица 5.5 — Таблица истинности комбинационной схемы автомата.
|S[j] |0 |0 |0 |0 |1 |1 |1 |1 | |Y0 |0 |0 |1 |1 |0 |0 |1 |1 | |Y1 |0 |1 |0 |1 |0 |1 |0 |1 | |S[j+1] |0 |0 |0 |1 |1 |1 |1 |1 | |X0 |1 |0 |0 |0 |0 |0 |0 |0 | |X1 |0 |0 |1 |0 |0 |0 |0 |0 | |X2 |0 |1 |0 |0 |0 |0 |0 |0 |.
7 Теперь можно записать логические выражения для комбинационной схемы автомата.
Функция переходов:
[pic]. (5.1).
Функции выходов в СДНФ по таблице истинности:
[pic]. (5.2).
Для удобства реализации комбинационной схемы представим рассматриваемые функции в базисе «ИЛИ-НЕ»:
[pic]. (5.3).
8 На основе системы (5.3), окончательно получаем цифровую схему реализации управляющего автомата транспортной тележки, представленную на рисунке 5.2.
Особенностью полученной схемы является то, что она не содержит элементы памяти и задержки и, соответственно, не является тактируемой. Такой вариант реализации возможен для автоматов с двумя состояниями, одно из которых является абсолютно устойчивым. В нашем случае состояние блокировки есть абсолютно устойчивое состояние. Если комбинационная схема сформируем это состояние, то за счёт обратной связи по линии S запрещается реакция выходов X на изменение входных сигналов Y. Выход из этого устойчивого состояния возможен только принудительным обнулением линии S единичным уровнем на линии «Сброс». Конфликтных «Состязаний» в рассматриваемом автомате не возникает.
Решение дополнительного задания.
1 Действующая на тележку в динамике система сил раскладывается на результирующую силу, приложенную к центру масс тележки [pic] и вращающий момент [pic], относительно того же центра масс.
2 Как видно из рисунка 1.1 вращающий момент определяется только силой реакции опоры переднего колеса [pic] —.
[pic], (6.1).
[pic] — угол поворота переднего колеса.
Зная из рисунка, что.
[pic], (6.2).
получим:
[pic]. (6.3).
Положительные значения вращающего момента соответствуют повороту тележки влево, отрицательные — вправо.
3 Результирующая сила, действующая на центр масс тележки, определяется векторной суммой всех сил на рисунке 1.1:
[pic]. (6.4).
Для нашего случая важно знать направление действия силы [pic], которое зависит от направлений и величин составляющих рассматриваемой суммы. В свою очередь направления составляющих рассматриваются относительно положения габаритной определяющей, которое характеризуется единичным вектором:
[pic], (6.5).
[pic] — вектор, задающий координаты центра масс тележки;
[pic] — вектор, задающий координаты точки приложения силы тяги [pic];
[pic] — габаритная определяющая транспортной тележки.
4 Вектор [pic] представляется в базисе вектора [pic] следующим образом:
[pic], (6.6).
[pic] — единичный вектор, ортогональный вектору [pic], или.
[pic]. (6.7).
Если [pic] имеет координаты [pic], то [pic] имеет координаты [pic]. Тогда вектор [pic], выраженный в базисе Декартовой системы координат, имеет вид:
[pic], (6.8).
[pic] — матрица (оператор) поворота вектора [pic] на угол [pic]. Теперь, используя выражение (6.2), окончательно найдём, что.
[pic]. (6.9).
5 Из рисунка 1.1 очевидным образом вытекают выражения для векторов силы тяги и приведённой силы трения, а именно:
[pic], (6.10).
[pic]. (6.11).
6 Центростремительная реакция трассы [pic] определяется произведением массы тележки и нормальной составляющей ускорения её центра масс, возникающей при закруглении траектории движения:
[pic], (6.12).
[pic] — центростремительное ускорение.
Если траектория движения центра масс задаётся вектором [pic], то.
[pic], (6.13).
[pic] — вектор скорости центра масс;
[pic] — вектор полного ускорения;
[pic] — оператор скалярного произведения векторов. Это физический факт. Вывод его опускаем.
7 Центр масс тележки смещается под действием результирующей силы [pic], при этом справедливо:
[pic]. (6.14).
8 Точка приложения силы тяги смещается под действием вращающего момента [pic], за счёт которого ей придаётся угловое ускорение [pic]:
[pic], (6.15).
[pic] — момент инерции тележки относительно центра масс.
Зная угловое ускорение можно найти тангенциальное [pic] в скалярной форме:
[pic],.
а затем и в векторной:
[pic], (6.16).
[pic] — векторная скорость изменения ориентации габаритной определяющей.
С другой стороны, — вектор тангенциального ускорения может быть выражен через полное ускорение вектора [pic]:
[pic], (6.17).
[pic] — вектор полного ускорения изменения ориентации габаритной определяющей;
В результате имеем связь:
[pic]. (6.18).
9 Учитывая, что приведённая сила трения пропорциональна модулю скорости центра масс:
[pic], (6.19).
[pic] — коэффициент трения, на основании всех найденных зависимостей путём исключения неизвестных нетрудно получить систему дифференциальных уравнений, являющуюся моделью динамики транспортной тележки в векторной форме. Записать эту систему в одну строчку проблематично, поэтому ограничимся указанием того, что первое дифференциальное уравнение системы строится на основе выражений: (6.3), (6.4), (6.5), (6.9), (6.10), (6.11), (6.13), (6.14), (6.19), а второе на основе: (6.3), (6.5), (6.18). Решением первого уравнения является зависимость траектории центра масс тележки от времени, решением второго — ориентация во времени вектора [pic].
Полученная система не имеет аналитического решения и поэтому должна решаться численно при любой зависимости от времени угла поворота [pic] и четырёх начальных условиях типа:
[pic], (6.20).
которые показывают, что в нулевой момент времени центр масс тележки находится в начале координат, скорость тележки равна нулю (и поступательная и вращательная), тележка сориентирована вертикально по оси [pic].
Для более детального учёта свойств транспортной тележки в динамики выражения векторов реакций трассы должны быть заменены на выражения с условиями сравнений в соответствии с допущениями, сформулированными в задании контрольной работы. ———————————;
Действие на трассу.
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
ц.
Д.
Д — датчики контраста; ц — центр масс тележки;
[pic] — вектор тяглового усилия двигателя;
[pic] — вектор приведенной силы трения;
[pic] — вектор реакции трассы (опоры) на переднее колесо;
[pic] — центростремительная реакция трассы;
[pic] — упрощенная габаритная определяющая;
[pic] — расстояние между датчиками контраста.
Рисунок 1.1 — Динамическая схема транспортной тележки.
[pic].
[pic].
Тележка.
[pic] — трёхразрядный управляющий сигнал;
[pic] — двухразрядный выходной сигнал.
Рисунок 1.2 — Структурная схема управления транспортной тележкой.
[pic].
Автомат.
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
Рисунок 5.1 — Минимизация функции переходов методом карт Карно.
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
[pic].
«Сброс».
Рисунок 5.2 — Цифровая схема управляющего автомата транспортной тележки.