Robot manipulátor - matematický model


  Matematický model robota je daný pohybovými rovnicami, ktorých počet je rovný počtu stupňov voľnosti. Tieto rovnice získame z Langrangeových rovníc druhého druhu, ktoré majú tvar:

 (1.1)

kde:  L je Langrageova funkcia
 n je počet stupňov
 qi je zovšeobecnená súradnica, odpovedajúca i-temu stupňu voľnosti
 Qi je zovšeobecnená sila, odpovedajúca zovšeobecnenej súradnici q

Lagrangeova funkcia je daná rozdielom kinetickej a potenciálnej energie:

 (1.2)

Zovšeobecnené sily uvažujeme v tvare:

 (1.3)

kde:
 ui je riadiaca veličina odpovedajúca i-temu stupňu voľnosti,
 Ki,Bi sú konštanty riadenia a tlmenia, odpovedajúce i-temu stupňu voľnosti

V tejto práci bude uvažovaný priemyselný robot-manipulátor s troma stupňami voľnosti s kinematickou štruktúrou a rozložením hmotnosti podľa obr.1.

robot.gif, 7 kB
Obr1. Kinematická štruktúra robota-manipulátora

K získaniu pohybových rovníc robota pre jednotlivé stupne voľnosti je najskôr potrebné odvodiť celkovú kinematickú a potenciálnu energiu, zvoliť zovšeobecnené súradnice, vytvoriť Lagrangeovu funkciu a jej derivácie podľa zovšeobecnených súradníc a špecifikovať tvar zovšeobecnenej sily (1.3), pričom uvažujeme Bi=0.

Parametre robota:

r=r1+r2 dĺžka ramena robota
mz hmotnosť závažia
m1 hmotnosť úchopovej hlavice a časti ramena
m2 hmotnosť motorov v ramene a časti ramena
m3 hmotnosť suportu
m4 hmotnosť rotujúcej časti stĺpa
m5 hmotnosť nerotujúcej časti stĺpa
z zdvih ramena
rotácia ramena

Z vyššie uvedeného postupu vyplýva, že matematický model priemyselného robota je vyjadrený troma diferenciálnymi rovnicami tvaru:

 (1.4)


 (1.5)


 (1.6)


kde:

je moment zotrvačnosti
je redukovaná hmotnosť elektromotora,prevodov a hnacej tyče
je redukovaný moment zotrvačnosti elektromotora a prevodovky
sú konštanty akčných veličín


 Rovnica (1.6) popisujúca zdvih ramena z je nezávislá na rovniciach pre rotáciu a výsuv ramena a preto ďalej budú riešené dva nezávislé pohyby popísané rovnicami (1.4) a (1.5). Pre vyjadrenie matematického modelu robota v stavovom priestore volíme substitučné vzťahy:

ktorými transformujeme rovnice (1.4) a(1.5) do tvaru:

(1.7)



(1.8)



(1.9)



(1.10)




Mail napíšte nám
© 2011 CyberEduCentre KKUI FEI TU Košice