RM_AxisSpline –  Interpolace požadované polohy (rychlosti, zrychlení)

Symbol blokuPotřebná licence: MOTION CONTROL
PIC

Popis funkce
Mnoho bloků pro řízení pohybu obsahuje výpočetně náročný algoritmus. To vede na relativně velké vzorkovací periody (typicky mezi 10 a 200ms). Naproti tomu regulátor motoru vyžaduje vzorkovací periodu malou (typicky do 1ms), aby nedocházelo k trhavému pohybu. Tyto protichůdné požadavky řeší blok RM_AxisSpline, který může běžet v jiné úloze (s kratší periodou vzorkování) než blok RM_Axis a provádí interpolaci hodnot, tak aby výsledná křivka byla spojitá a pokud možno hladká.

Pro napojení na blok RM_Axis lze použít dvě možnosti: buď se musí předávat všechny potřebné hodnoty (výstupy bloku RM_AxisOut) nebo se předá odkaz a zajistí správná synchronizace. Blok RM_AxisSpline používá předávání hodnot odkazem. Pro správnou synchronizaci musí blok RM_Axis být spouštěn jako první, následují všechny ostatní bloky (spojené s touto osou) a nakonec blok RM_AxisOut.

Poznámka 1: Pro interpolaci polohy je použit polynom třetího řádu p(t), přičemž ps (0) = pos0,ps(tS) = pos1, dps(t) dt t=0 = vel0, dps(t) dt t=tS = vel1. Pro interpolaci rychlosti je také použit polynom třetího řádu pv (t), kde pv (0) = vel0,pv(tS) = vel1, dpv(t) dt t=0 = acc0, dpv(t) dt t=tS = acc1. Pro interpolaci momentu/síly je použita pouze lineární interpolace.

Poznámka 2: Protože doba vykonávání bloků pro řízení pohybu značně kolísá, dostává interpolátor nové hodnoty neekvidistantně, přičemž výstup interpolátoru musí být souvislý. Proto se podle potřeby pro interpolaci používá aktuální hodnota, jednokroková predikce nebo dvoukroková predikce a tomu odpovídají stavy interval0, interval1, interval2. Důležité je pravidlo, že stavy odpovídající kladným číslům jsou normální činnost a stavy odpovídající záporným číslům představují chybu.

Poznámka 3: Řídící systém REXYGEN řadí bloky podle toku signálu a druhotně podle jména bloku (abecedně, vzestupně). Blok je proto vhodné pojmenovat „zzz“ a podobně. Pro kontrolu pořadí spouštění bloků je možné použít REXYGEN Diagnostics , kde jsou bloky řazeny v pořadí, jak se vykonávají.

2022 © REX Controls s.r.o., www.rexygen.com