Hlubší pohled na oborové aplikace

Odometrie hnacích kol AGV: průměr, počet rysek a chyba odhadu polohy

Odometrie hnacích kol AGV: průměr, počet rysek a chyba odhadu polohy

Diferenciální AGV provádějí odhad polohy (dead reckoning) enkodéry hnacích kol. Tento článek spočítá rozlišení 5,89 μm při průměru kola 150 mm, převodovém poměru 20 a 1000 ryskách, porovná rozdíl mezi kvantizační chybou (0,24 mm na 10 m) a 0,5% rozdílem průměrů kol (0,5 m) a uvede rozumný interval rozlišení a priority kalibrace.

Odhad polohy diferenciálního AGV používá pouze enkodéry dvou hnacích kol: v každé vzorkovací periodě se vezmou posunutí levého a pravého kola a změna kursu se získá z jejich rozdílu. Při výběru se často objeví otázka: čím vyšší je počet rysek motorového enkodéru, tím přesnější je odometrie? Oddělí-li se chyby podle původu, odpověď je ne.

AGV ujede 10 m po přímce: při 0,5% rozdílu průměrů obou kol se odhadovaná dráha (červeně) postupně odchyluje od skutečné přímky (modře); příčná odchylka roste s druhou mocninou vzdálenosti a v koncovém bodě je 0,5 m; kvantizační chyba ±1 kroku je pouze 0,24 mm
Obrázek 1 – AGV ujede 10 m po přímce: při 0,5% rozdílu průměrů obou kol se odhadovaná dráha (červeně) postupně odchyluje od skutečné přímky (modře); příčná odchylka roste s druhou mocninou vzdálenosti a v koncovém bodě je 0,5 m; kvantizační chyba ±1 kroku je pouze 0,24 mm

Model: jak se chyba kursu stane příčnou odchylkou

Nechť přírůstky posunutí levého a pravého kola jsou Δs_L a Δs_R a rozchod b. Pak

Δs = (Δs_R + Δs_L)/2,Δψ = (Δs_R − Δs_L)/b

kde Δs je posun vozidla vpřed a Δψ je změna kursu. Chyba kursu ψ_err po každém dalším posunu s přidá příčnou odchylku ψ_err·s. Obě třídy chyb se chovají jinak:

  • Omezená chyba: kvantizace enkodéru. Počet kroků je kumulativní veličina a neztrácí se; kumulativní chyba posunutí každého kola nikdy nepřekročí ±1 krok, chyba kursu je omezená a příčná odchylka roste se vzdáleností pouze lineárně.
  • Akumulující se chyba: dráha na otáčku se mezi dvěma koly liší, například kvůli rozdílu průměrů nebo chybě účinného rozchodu. Samotná chyba kursu roste se vzdáleností a příčná odchylka roste s druhou mocninou vzdálenosti.

Kvantizační chyba: rozlišení 5,89 μm

Numerický příklad: průměr kola 150 mm (obvod 471,2 mm), převodový poměr 20, motorový enkodér s 1000 ryskami a čtyřnásobným vyhodnocením. Pak

kroky na otáčku kola = 4000 × 20 = 80 000,na krok = 471,2 mm ÷ 80 000 = 5,89 μm

Každé z obou kol má odchylku ±1 krok. Při rozchodu 0,5 m je horní mez chyby kursu Δψ = 2 × 5,89 μm ÷ 0,5 m = 2,36×10⁻⁵ rad (4,9″). Po 10 m jízdy přímo je horní mez příčné odchylky 2,36×10⁻⁵ × 10 m = 0,24 mm.

Rozdíl průměrů kol: kvadratický růst

Liší-li se oba průměry o ε, a je-li skutečná dráha přímka, obě kola ve skutečnosti urazí stejnou vzdálenost, kdežto odhad s jmenovitými průměry dá rozdíl drah vlevo a vpravo ε·s, proto

ψ(s) = ε·s/b,y(s) = ε·s²/(2b)

kde y je příčná odchylka odhadované polohy od skutečné dráhy. Pro ε = 0,5 % (rozdíl průměrů asi 0,75 mm na kole 150 mm, například nerovnoměrné opotřebení) a b = 0,5 m je na 10 m ψ = 0,1 rad (5,7°) a y = 0,5 m. Naopak, jsou-li obě kola řízena na stejný počet kroků podle jmenovitých průměrů, skutečná dráha se ohne do oblouku o poloměru b/ε = 100 m a odchylka má stejnou velikost. Pro b = 0,5 m platí y = ε·s²:

ε \ s2 m5 m10 m20 m
0,1 %4 mm25 mm100 mm400 mm
0,5 %20 mm125 mm500 mm2000 mm

Velikosti jednotlivých chyb na 10 m ukazuje obrázek 2. Rozdíl průměrů 0,5 % je asi 2100krát větší než kvantizační chyba; je-li účinný rozchod o 1 % vedle, po otočení o 90° je kurs o 0,9° větší a 10 m jízdy přímo se odchýlí o 157 mm; jsou-li obě kola současně o 0,5 % menší, kurs není ovlivněn a objeví se jen chyba vzdálenosti 50 mm ve směru jízdy.

Odhadované chyby po 10 m jízdy přímo (logaritmická osa): kvantizace je nejmenší; systematické členy jako rozdíl průměrů a chyba rozchodu jsou o dva až tři řády větší; po kalibraci rozdílu průměrů na ±5 mm zbývá zbytek asi 5 mm
Obrázek 2 – Odhadované chyby po 10 m jízdy přímo (logaritmická osa): kvantizace je nejmenší; systematické členy jako rozdíl průměrů a chyba rozchodu jsou o dva až tři řády větší; po kalibraci rozdílu průměrů na ±5 mm zbývá zbytek asi 5 mm

Rozumný interval rozlišení

Dolní mez rozlišení určuje měření rychlosti při nízké jízdě, nikoli odometrie. Při nejmenší jízdní rychlosti 50 mm/s a okně měření 10 ms je počet kroků uražených v okně 0,05 × 0,01 ÷ 5,89 μm = 85 a rozlišení rychlosti je asi 1,2 %. Požaduje-li se nejméně 2 % (alespoň 50 kroků), každý krok nesmí být větší než 10 μm, tedy nejméně 47 100 kroků na otáčku kola, což při čtyřnásobném vyhodnocení a převodovém poměru 20 odpovídá enkodéru s asi 590 ryskami nebo více. Při 1000 ryskách je hodnota 1,2 %, při 500 ryskách 2,4 % (obrázek 3).

Horní mez nemá smysl: i když se počet rysek dále zvýší a příčná chyba z kvantizace klesne z 0,24 mm na 0,02 mm, proti systematické odchylce 0,5 m to nic nezmění. Používá-li motor již enkodér 17–23 bitů, lze jej použít jak je; rozlišení není třeba zvedat zvlášť pro odometrii. Při ještě nižší rychlosti lze metodou intervalu mezi impulsy (metoda M/T) zlepšit rozlišení rychlosti bez zvýšení počtu rysek.

Počet rysek a rozlišení: při každém zdvojnásobení počtu rysek se poloviční jak rozlišení rychlosti, tak kvantizační příčná chyba, které při 1000 ryskách činí 1,2 % a 0,24 mm
Obrázek 3 – Počet rysek a rozlišení: při každém zdvojnásobení počtu rysek se poloviční jak rozlišení rychlosti, tak kvantizační příčná chyba, které při 1000 ryskách činí 1,2 % a 0,24 mm

Priority kalibrace

  • Rozdíl průměrů kol: nechat AGV ujet 10 m přímo bez korekce kursu, změřit příčnou odchylku y skutečné dráhy od přímky, pak ε = 2·b·y/s². Chyba kursu na začátku přinese lineární člen, proto je vhodné kvadratické proložení v několika bodech vzdálenosti. Při chybě měření y ±5 mm je nejistota ε rovna 2 × 0,5 × 0,005 ÷ 100 = 0,005 %. Po kalibraci je zbytková odchylka na vzdálenosti s asi ±5 mm × (s/10 m)².
  • Účinný rozchod: otočit na místě o několik otáček, změřit skutečný úhel vnějším referenčním prvkem (například pevným terčem) a porovnat s odhadnutým úhlem, aby se získal korekční činitel.
  • Změna v čase: průměr polyuretanových kol se mění s opotřebením, zatížením a teplotou; je třeba je pravidelně znovu kalibrovat, nebo gyroskop dodá kurs a odhadne rozdíl průměrů online.
  • Prokluz: enkodér je na straně motoru, proto prokluz a tečení běhounu nejsou vidět; je nutná periodická korekce podle orientačních bodů nebo laserového určování polohy.

Technické body

  • Nejprve spočítat řád jednotlivých zdrojů chyb: kvantizace 0,24 mm, 0,5% rozdíl průměrů už 0,5 m — zlepšovat je třeba ten druhý.
  • Rozlišení 5–10 μm na krok je pro odometrii již dostatečné; 1000 rysek a 5,89 μm/krok je rozumný výchozí bod.
  • Dolní mez počtu rysek je dána požadavkem alespoň 50 kroků v okně měření rychlosti při nejnižší jízdě, asi 590 rysek (převodový poměr 20, čtyřnásobné vyhodnocení).
  • Kalibrovat rozdíl průměrů z příčné odchylky 10m jízdy přímo: ε = 2·b·y/s²; přesnost měření ±5 mm odpovídá 0,005 %.
  • Levé a pravé kolo volit ze stejné dávky a ve stejném stavu opotřebení a rozdíl průměrů pravidelně ověřovat; už 0,1% rozdíl dá na 10 m odchylku 100 mm.
  • Odometrie pokrývá jen relativní polohu v krátkém čase; na dlouhých vzdálenostech koriguje gyroskop nebo orientační body.

Stručně

Chybu odometrie hnacích kol ovládají systematické členy: kvantizace je omezená a na 10 m činí jen 0,24 mm; rozdíl průměrů nechá příčnou odchylku růst s druhou mocninou vzdálenosti a 0,5 % je už 0,5 m. Rozlišení enkodéru 5–10 μm/krok už stačí; vysoký počet rysek odometrii nezlepší. Stojí za investici kalibrace rozdílu průměrů a rozchodu a pravidelná korekce gyroskopem nebo orientačními body.


Překlad čínského originálu (0766). ENC7 – výrobce kódových kotoučů (poptávka) · Odborné články · https://enc7.com

© Langfang Jingzheng Optoelectronic Technology Co., Ltd. Všechna práva vyhrazena. Článek vznikl s pomocí AI.

Have a drawing? Get an engineer's review.

Send your outer diameter, bore, line count or bit count, substrate and readhead wavelength. Our engineers check manufacturability and reply with a quotation and sample lead time.

WhatsApp