1. Модел кретања (1.1)

Σχετικά έγγραφα
налазе се у диелектрику, релативне диелектричне константе ε r = 2, на међусобном растојању 2 a ( a =1cm

Предмет: Задатак 4: Слика 1.0

1.2. Сличност троуглова

предмет МЕХАНИКА 1 Студијски програми ИНДУСТРИЈСКО ИНЖЕЊЕРСТВО ДРУМСКИ САОБРАЋАЈ II ПРЕДАВАЊЕ УСЛОВИ РАВНОТЕЖЕ СИСТЕМА СУЧЕЉНИХ СИЛА

Теорија електричних кола

Анализа Петријевих мрежа

7. ЈЕДНОСТАВНИЈЕ КВАДРАТНЕ ДИОФАНТОВE ЈЕДНАЧИНЕ

b) Израз за угиб дате плоче, ако се користи само први члан реда усвојеног решења, је:

Положај сваке тачке кружне плоче је одређен са поларним координатама r и ϕ.

2. Наставни колоквијум Задаци за вежбање ОЈЛЕРОВА МЕТОДА

Когнитивне способности мобилних робота у домену унутрашњег транспорта материјала

Ротационо симетрична деформација средње површи ротационе љуске

Tестирање хипотеза. 5.час. 30. март Боjана Тодић Статистички софтвер март / 10

Вектори vs. скалари. Векторске величине се описују интензитетом и правцем. Примери: Померај, брзина, убрзање, сила.

ОБЛАСТИ: 1) Тачка 2) Права 3) Криве другог реда

TAЧКАСТА НАЕЛЕКТРИСАЊА

Писмени испит из Метода коначних елемената

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ, НАУКЕ И ТЕХНОЛОШКОГ РАЗВОЈА ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА МАТЕМАТИКА ТЕСТ

5.2. Имплицитни облик линеарне функције

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ, НАУКЕ И ТЕХНОЛОШКОГ РАЗВОЈА ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА

Основе теорије вероватноће

& 2. Брзина. (слика 3). Током кратког временског интервала Δt тачка пређе пут Δs и изврши елементарни (бесконачно мали) померај Δ r

6.2. Симетрала дужи. Примена

г) страница aa и пречник 2RR описаног круга правилног шестоугла јесте рац. бр. јесу самерљиве

СИСТЕМ ЛИНЕАРНИХ ЈЕДНАЧИНА С ДВЕ НЕПОЗНАТЕ

КРУГ. У свом делу Мерење круга, Архимед је први у историји математике одрeдио приближну вред ност броја π а тиме и дужину кружнице.

3.1. Однос тачке и праве, тачке и равни. Одређеност праве и равни

2.3. Решавање линеарних једначина с једном непознатом

ВИСОКА ТЕХНИЧКА ШКОЛА СТРУКОВНИХ СТУДИЈА У НИШУ

Семинарски рад из линеарне алгебре

8. ПИТАГОРИНА ЈЕДНАЧИНА х 2 + у 2 = z 2

2. EЛЕМЕНТАРНЕ ДИОФАНТОВЕ ЈЕДНАЧИНЕ

Математички модел осциловања система кугли око равнотежног положаја под утицајем гравитационог поља

Слика 1. Слика 1.2 Слика 1.1

1. Математички доказ закона кретања мобилног робота

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ, НАУКЕ И ТЕХНОЛОШКОГ РАЗВОЈА ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ И НАУКЕ ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА

ТРАПЕЗ РЕГИОНАЛНИ ЦЕНТАР ИЗ ПРИРОДНИХ И ТЕХНИЧКИХ НАУКА У ВРАЊУ. Аутор :Петар Спасић, ученик 8. разреда ОШ 8. Октобар, Власотинце

МАТРИЧНА АНАЛИЗА КОНСТРУКЦИЈА

Аксиоме припадања. Никола Томовић 152/2011

РЕШЕЊА ЗАДАТАКА - IV РАЗЕД 1. Мањи број: : x,

6.1. Осна симетрија у равни. Симетричност двеју фигура у односу на праву. Осна симетрија фигуре

СТАБИЛНОСТ ТРАКТОРА У КРИВИНИ

Количина топлоте и топлотна равнотежа

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ, НАУКЕ И ТЕХНОЛОШКОГ РАЗВОЈА ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА

Упутство за избор домаћих задатака

Писмени испит из Теорије површинских носача. 1. За континуалну плочу приказану на слици одредити угиб и моменте савијања у означеним тачкама.

Први корак у дефинисању случајне променљиве је. дефинисање и исписивање свих могућих eлементарних догађаја.

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ, НАУКЕ И ТЕХНОЛОШКОГ РАЗВОЈА ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА

Осцилације система са једним степеном слободе кретања

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ, НАУКЕ И ТЕХНОЛОШКОГ РАЗВОЈА ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА ТЕСТ МАТЕМАТИКА

Универзитет у Београду Машински факултет

Универзитет у Београду, Саобраћајни факултет Предмет: Паркирање. 1. вежба

4.4. Паралелне праве, сечица. Углови које оне одређују. Углови са паралелним крацима

ПРИЈЕМНИ ИСПИТ. Јун 2003.

4. Троугао. (II део) 4.1. Појам подударности. Основна правила подударности троуглова

1. 2. МЕТОД РАЗЛИКОВАЊА СЛУЧАЈЕВА 1

6.3. Паралелограми. Упознајмо још нека својства паралелограма: ABD BCD (УСУ), одакле је: а = c и b = d. Сл. 23

8.5 ЛАБОРАТОРИЈСКА ВЕЖБА 5 Задатак вежбе: PI регулација брзине напонски управљаним микромотором једносмерне струје

7.3. Површина правилне пирамиде. Површина правилне четворостране пирамиде

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ И НАУКЕ ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА

10.3. Запремина праве купе

ВИСОКА ТЕХНИЧКА ШКОЛА СТРУКОВНИХ СТУДИЈА У НИШУ

Теорија електричних кола

ЗБИРКА РЕШЕНИХ ЗАДАТАКА ЗА ПРИЈЕМНИ ИСПИТ ИЗ МАТЕМАТИКЕ

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ, НАУКЕ И ТЕХНОЛОШКОГ РАЗВОЈА ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА

ЛИНЕАРНА ФУНКЦИЈА. k, k 0), осна и централна симетрија и сл. 2, x 0. У претходном примеру неке функције су линеарне а неке то нису.

6.5 Површина круга и његових делова

8.2 ЛАБОРАТОРИЈСКА ВЕЖБА 2 Задатак вежбе: Израчунавање фактора појачања мотора напонским управљањем у отвореној повратној спрези

Примена MATLAB-a за прорачун механике индустријског робота и израда лабораторијског модела применом RP технологија

Универзитет у Крагујевцу Факултет за машинство и грађевинарство у Краљеву Катедра за основне машинске конструкције и технологије материјала

6. ЛИНЕАРНА ДИОФАНТОВА ЈЕДНАЧИНА ах + by = c

ЗБИРКА РИЈЕШЕНИХ ЗАДАТАКА ИЗ МАТЕМАТИКЕ ЗА ПРИЈЕМНИ ИСПИТ

L кплп (Калем у кплу прпстпперипдичне струје)

4. ЗАКОН ВЕЛИКИХ БРОЈЕВА

Факултет организационих наука Центар за пословно одлучивање. PROMETHEE (Preference Ranking Organization Method for Enrichment Evaluation)

ЕНЕРГЕТСКИ ПРЕТВАРАЧИ 2 (13Е013ЕП2) октобар 2016.

Кинематика и динамика у структуралном инжењерству, Звонко Ракарић, Механика 2, грађевинарство, Факултет техничких наука, Нови Сад,2017

Скупови (наставак) Релације. Професор : Рака Јовановић Асиситент : Јелена Јовановић

ПОВРШИНа ЧЕТВОРОУГЛОВА И ТРОУГЛОВА

ЗАШТИТА ПОДАТАКА Шифровање јавним кључем и хеш функције. Diffie-Hellman размена кључева

Закони термодинамике

Координатни системи у физици и ОЕТ-у

Висока техничка школа струковних студија Београд Математика 2 Интервали поверења и линеарна регресија предавач: др Мићо Милетић

Тангента Нека је дата крива C са једначином y = f (x)

Cook-Levin: SAT је NP-комплетан. Теодор Најдан Трифунов 305M/12

Терминирање флексибилних технолошких процеса

Република Србија МИНИСТАРСТВО ПРОСВЕТЕ И НАУКЕ ЗАВОД ЗА ВРЕДНОВАЊЕ КВАЛИТЕТА ОБРАЗОВАЊА И ВАСПИТАЊА

Нумеричко решавање парцијалних диференцијалних једначина и интегралних једначина

1. Моделирање и модели, врсте модела. 2. Неформални и формални модели

ТАНГЕНТА. *Кружница дели раван на две области, једну, спољашњу која је неограничена и унутрашњу која је ограничена(кружницом).

ttl КОНСТРУИСАЊЕ МОБИЛНИХ МАШИНА манипулатори машина, полужни погонски механизми Конструисање мобилних машина Седмо предавање

У н и в е р з и т е т у Б е о г р а д у Математички факултет. Семинарски рад. Методологија стручног и научног рада. Тема: НП-тешки проблеми паковања

Једна од централних идеја рачунарства Метода која решавање проблема своди на решавање проблема мање димензије

Скрипта ријешених задатака са квалификационих испита 2010/11 г.

Универзитет у Београду Машински факултет

Погодност за одржавање, Расположивост, Марковљеви ланци

ТЕСТ МАТЕМАТИКА УПУТСТВО ЗА ПРЕГЛЕДАЊЕ

РЕШЕНИ ЗАДАЦИ СА РАНИЈЕ ОДРЖАНИХ КЛАСИФИКАЦИОНИХ ИСПИТА

Стручни рад ПРИМЕНА МЕТОДЕ АНАЛИТИЧКИХ ХИЕРАРХИJСКИХ ПРОЦЕСА (АХП) КОД ИЗБОРА УТОВАРНО -ТРАНСПОРТНЕ МАШИНЕ

Transcript:

1. Модел кретања Кинематика, у најопштијој формулацији, може да буде дефинисана као геометрија кретања. Другим речима, применом основног апарата математичке анализе успостављају се зависности између елементарних кинематичких величина, а на тај начин се и решава постављени проблем. Претпоставља се да је систем мобилног робота из једног положаја, изабраним кретањем, прешао у неки други положај, а приликом анализе тог кретања не занимају нас физичке величине нпр. силе које су произвеле кретање нити рецимо оне силе које се супротстављају самом кретању. У фокусу кинематичке анализе је само кретање, а узрок и последице су ирелевантни. Кинематичка анализа мобилних робота је већ дуги низ година једна од најинтересантнијих области роботике, без обзира да ли се ради о ''точкашима'', ''гусеничарима'' или роботима који своје кретање остварују помоћу ногу. Неће звучати претенциозно ако се каже да је већина кинематичких модела мобилних робота већ успостављена у потпуности и потребно их је само проширити и уопштити у циљу потпуне имплементације на реалне проблеме. Сви до сада изведени кинематички модели мобилних робота који своје кретање остварују помоћу точкова су детерминистичке природе. Карактер промене параметара процеса је детерминистички и самим тим се не дозвољава постојање ни најмање грешке. Наравно, у реалним проблемима детерминистички модели веома брзо покажу сва своја ограничења па је то један од основних разлога примене стохастичких метода. Наиме, стохастичке методе дозвољавају постојање грешке модела чиме се знатно добија на општости модела, а самим тим и на могућност имплементације на стварном моделу у реалном времену и окружењу. Са кинематичке тачке гледишта, у општем случају вектор стања система чине следеће компоненте: x = { x, y, z,, ψ, ϕ} 1.1 где су x, y и z компоненте вектора које дефинишу позицију мобилног робота, а, ψ, ϕ углови који одређују оријентацију мобилног робота у односу на неки спољашњи координатни систем. У оквиру овог курса, кретање робота ће бити моделирано као равно кретање, па је сходно броју степени слободе 1 крутог тела у равни довољно дефинисати вектор стања чије су компоненте: x } = { x, y, 1. 1 Број независних параметара који једнозначно дефиинишу кретање тела.

где x, y представљају координате тежишта мобилног робота у односу на неки спољашњи координатни систем а угао одређује оријентацију робота у односу на x осу слика 1.1. Слика 1.1 Дефиниција степени слободе мобилног робота у равни x-y Модел промене стања је представљен следећом релацијом : p x / x, u 1.3 1 Иако је термин модел промене стања погоднији, није грешка ни да се модел промене стања назове модел кретања. Наиме, мобилни робот из стања које је дефинисано вектором x-1 у тренутку -1 управљањем u прелази у стање које је одређено вектором x у тренутку. С обзиром да мобилни робот мора да промени позицију и у општем случају и оријентацију да би променио стање, сасвим је јасно да то може бити остварено једино кретањем. То је и основни разлог увођења термина модел кретања. Приликом дефинисања модела кретања мобилног робота на основу кога ће локализација бити извршена, могуће је дефинисати два основна правца: Модел кретања на основу брзина Брзински модел кретања у овом моделу транслаторна и угаона брзина кретања мобилног робота представљају управљања u која изазивају промену позиције и оријентације током експлоатације. Основна претпоставка овог модела кретања је да се транслаторна и угаона брзина кретања могу контролисати, односно да се њима може директно управљати, што је и основна претпоставка на којој почива овај модел. Модел кретања на основу пређеног пута Одометрија у овом моделу управљање u је дефинисано пређеним путем точкова мобилног робота током тачно дефинисаног временског интервала. На основу очитавања података са енкодера, и након интеграције, могу се одредити параметри пређеног пута неопходни за постављање модела. Међутим, посматрано са гледишта управљања роботом, пређени пут точкова дефинитивно потпада под мерења сензорске информације и у суштини представља резултат

управљања и рада мотора, ипак у овом моделу кретања основна претпоставка је да управо пређени пут, као директан резултат управљања моторима мобилног робота, може бити усвојен за управљачку величину. Основни разлог овако усвојеног управљања u је могућност да се у оквиру управљачког софтвера мобилног робота пређени пут директно контролише унапред дефинисаним потпрограмом главног управљачког алгоритма на следећи начин: move_forwarisance или move_backwarisance. Општи кинематички модел кретања мобилног робота базиран на стохастици не постоји и у суштини за сваки појединачни проблем потребно је извршити анализу, на чијим резултатима ће се формирати и сам модел. Основна поставка кинематичког модела кретања зависи како од основне кинематичке конфигурације мобилног робота број точкова, укупни број степени слободе, број степени слободе којима се може управљати итд., тако и од карактеристика окружења у коме робот остварује кретање, управљачког алгоритма итд. Самим тим модел кретања се усваја и развија зависно од специфичности проблема. 1.1 Модел кретања на основу пређеног пута Као што је у основној формулацији овог модела кретања речено, мерења очитана са енкодера након интеграције дефинишу се као управљања и као таква ''прослеђују'' Калмановом филтеру прилог В у циљу одређивања позиције и оријентације мобилног робота. Важно је напоменути да сваки модел који се заснива на одометрији користи искључиво релативне координате, односно, пређени пут се мери помоћу енкодера од неког положаја у коме је мобилни робот био у тренутку -1 до неког положаја у тренутку, што значи да је измерени пређени пут пут који је робот прешао између ова два узастопна положаја. Наравно, релативни пређени пут између ова два положаја неком математичком трансформацијом је неопходно ''пребацити'' у спољашњи координатни систем у коме је и дата мапа окружења, а у односу на који и треба извршити локализацију. С друге стране, таква погодна трансформација координата, која би успоставила математичку зависност између спољашњег координатног система и координатног система робота у коме су и дефинисана померања, а тиме и мерења пређеног пута, не постоји, па је то заправо основни разлог што се користе искључиво релативна померања и мерења пређеног пута. Међутим, таква трансформација би у потпуности успоставила и одредила поменуто нелинеарно пресликавање, што је практично немогуће, с обзиром на немогућност дефинисања свих ограничења и реалних утицаја током кретања. Управо претходна чињеница представља кључни разлог постојања и развијања метода локализације мобилних робота. У наставку ће бити представљен једноставан модел кретања изведен на основу пређеног пута мобилног робота. Модел може да се примени искључиво на оне мобилне роботе који имају два погонска точка која се могу окретати потпуно независно један од другог. Другим речима, управљањем смером обртања точкова контролише се скретање мобилног робота. На ''осовинама'' точкова су монтирани енкодери који мере углове ротације обртање точкова. Модел се може успоставити Differenia Drive Mobie obos, енг. 3

математички доказати без већих проблема на следећи начин. С обзиром да се анализа односи на раванско кретање, што значи да се претпоставља кретање робота током експлоатације у сваком временском тренутку, а да може бити описано са три независна параметра степена слободе дата вектором чије су компоненте очигледно: x ' } = { x y 1.4 Одређивање позиције и оријентације за овакав тип мобилног робота, који своје кретање остварује помоћу точкова, своди се на интеграцију података очитаних са енкодера који се налазе на точковима, односно, сумирање пређеног пута погонских точкова у сваком инкременталном временском интервалу : x = s cos / 1.5 y = ssin / 1.6 s s = 1.7 b где су s s s = 1.8 x, y, - величине које дефинишу путању мобилног робота у току интервала, s, s - пређени пут десног и левог погонског точка респективно, b - размак између точкова. Слика 1. Мобилни робот са два независна погонска точка На слици 1. је приказан основни модел, одакле се на основу геометрије једноставно одређује вектор стања мобилног робота након извршеног управљања : 4

x scos / x ' = y ssin / 1.9 Даље се, након сређивања, одређује следећи израз: s s s s cos x b s s s s x' = y sin x' = f x, y,, s b s s b, s 1.1 што представља основни кинематички модел кретања мобилног робота изведен на основу пређеног пута погонских точкова. Из горње једнакости може се видети које величине утичу на промену али и на могућност израчунавања позиције и оријентације. Израз 1.1 заправо представља модел кретања модел промене стања p x / x, u који фигурише у основним једначинама поменутог Калмановог филтера. 1 Наравно, претходна формулација модела кретања базираног на одометрији није и једина, постоји велики број развијених модела кретања од којих се издваја следећи модел 1.11. Наиме, за разлику од претходног модела кретања, у коме су управљања дефинисана релацијом u = { s s } у овом моделу се претпоставља да су управљања одређена на следећи начин: = { 1 1.11 u x x } где су x = x y } - вектор стања система који обухвата позицију и оријентацију 1 { 1 1 1 мобилног робота у тренутку -1, ' ' ' x = { x y } - вектор стања система у тренутку. Наравно, управљања у овом моделу су управо релативна померања x 1, x, односно кретања мобилног робота посматрана из роботског координатног система при чему је веза између унутрашњег и спољашњег координатног система потпуно непозната. 1. Брзински модел кретања мобилног робота За разлику од модела кретања изведеног на основу пређеног пута, брзински модел полази од претпоставке да се транслаторном и угаоном брзином мобилног робота може директно управљати сетом команди које је могуће задати мобилном роботу преко управљачког софтвера, а које мобилни робот треба да спроведе: forwar_veociynumeric_vaue,ime_uraion или anguar_veociynumeric_vaue, 5

6 ime_uraion. Наравно, сада је апсолутно оправдано формирати вектор управљања на следећи начин: v u } { = 1.1 где су v - транслаторна брзина кретања центра маса, - угаона брзина мобилног робота. Кинематички модел, приказан на слици 1.3 континуални облик, дат је преко: = y x y x 1 sin 1 cos 1 1.13 Слика 1.3 Кинематички модел континуални облик где су: x - х координата тежишта мобилног робота у тренутку = y - у координата тежишта мобилног робота у тренутку = - Угао ротације мобилног робота у тренутку = - Полупречник левог точка

- Полупречник десног точка - Угаона брзина десног точка - Угаона брзина левог точка - Размак између точкова Даље је основни кинематички модел дат у дискретном облику: x k 1 x k v k cos k k = y k 1 y k v k sin k k k 1 k k 1.14 где су x k - х координата мобилног робота у тренутку k y k - у координата мобилног робота у тренутку k k - Угао ротације мобилног робота у тренутку k k = - Размак између точкова = k прираштај угла - Полупречник левог точка - Полупречник десног точка - Угаона брзина десног точка - Угаона брзина левог точка С обзиром да је овај модел дискретан модел кретања, као и претходни, ознаке за временске тренутке k1 и k су идентички једнаке временским тренутцима 1 и респективно. Коришћењем слике 1.3 могуће је успоставити основне везе неопходне за извођење горњих релација. Важно је напоменути да представља временски интервал трајања кретања из положаја k у положај k1. Све претходне релације се веома лако изводе коришћењем основа кинематике крутог тела. 7

1.3 Дискусија На основу једначина модела кретања изведених на основу пређеног пута и модела на основу брзина кретања мобилног робота могуће је изразити и дефинисати нелинеарну функцију gu,x-1 која врши пресликавање вектора управљања табела 1.1 и вектора претходног стања система простор стања система у тренутку у простор стања система у тренутку 1. Помоћу ове функције, након линеаризације Тејлоровим редом и срачунате Јакобијан матрице трансформације у сваком тренутку, могуће је применити једначине Линеаризованог Калмановог филтера. Оба модела кретања полазе од основних кинематичких поставки крутог тела у равни три степена слободе, након чега следи увођење оних компоненти које су у реалним условима подложне генерисању грешке. Табела 1.1 Поређење модела кретања Модел промене стања Модел кретања Одометрија Брзински модел Компоненте вектора управљања u u = { s s } u = { } v Приказани модели кретања мобилног робота који своје кретање остварује помоћу точкова нису и једини који постоје. Наиме, могуће је дефинисати знатно више ако не и бесконачно модела кретања мобилних робота али су за потребе овог курса приказана два модела који се и највише примењују. Оба модела су изведена на основу кинематичке формулације кретања чиме се модели знатно поједностављују. Међутим, изучавање кретања без утицаја сила, како дисипативних тако и погонских, није потпуно реалан модел кретања, али се за мобилне роботе који бораве у затвореном простору канцеларије, болнице, универзитетски комплекси итд. ова апроксимација може усвојити. У таквим срединама динамика мора бити разматрана у поступку локализације мобилног робота. ''Екстраполација'' кинематичких пробабилистичких модела на динамичке моделе је аналогна оригиналној формулацији кинематичких модела, односно након постављања основног модела, накнадно се додају стохастичке компоненте у циљу што бољег моделирања и сагледавања система мобилног робота и утицаја реалног окружења. Као што се из претходног може закључити, општи алгоритам који би дефинисао начин и смернице избора кинематички или динамички пробабилистички модел кретања, да ли усвојити брзински или модел на основу пређеног пута, итд. не постоји, и једина препорука која се може дати је да се модели кретања изводе у зависности од основних карактеристика мобилног робота али и карактеристика окружења у коме ће се робот кретати. 8