Ovladani osmi serv pomoci UARTu
Moderátor: Moderátoři
Ovladani osmi serv pomoci UARTu
Zdravim,
potreboval bych ovladat 8 klasickych modelarskych serv (generovani kladneho pulsu o delce 0,5-2,5ms, o frekvenci 50Hz) pres seriovou linku s (asi) ATmega8, rozliseni 1024 kroku.
Napadu, jak realizovat generovani ridiciho pulsu, jsem mel spoustu, v podstate prezily dva.
-vzit prijatou hodnotu pro servo 1, prepocitat strop pro citac, nastavit strop citace, nastavit vystup pro prvni servo na 1, zapnout citac, pri preruseni od citace vsechny vystupy na serva nastavit na 0, vzit prijatou hodnotu pro servo 2, prepocitat strop pro citac, nastavit strop citace, nastavit vystup pro druhe servo na 1, zapnout citac, pri preruseni vsechny vystupy na serva nastavit na 0...
to cele opakovat 50x za sekundu.
-podobne jako minule, pouzit opet citac nebo PWM, ale prepinat vystupy demuxem (a ten by sel mozna prepinat vystupem citace pri nabezne hrane signalu pro dalsi servo), mozna by se usetrilo trosicku casu, ale asi to nebude prilis vyznamne
Radsi bych pouzil prvni variantu. Ovsem nejak nedokazu do toho zakomponovat prijem dat. Rad bych mel data ve formatu 1byte adresa + 8x2byte poloha, s tim, ze adresni byte by treba mel MSB=0 a poloha by mela MSB=1 aby se to rozlisilo.
(ovladaci SW budu psat sam, takze format muze byt jiny)
Pri 9600Bd by melo trvat prenest 17bytu zhruba 16ms, coz je moc, nemuzu stravit 16ms pouze prijmem dat. Takze, co s tim?
Program bude v C, jsem zacatecnik, takze prosim poradte nejak srozumitelne.
Diky.
potreboval bych ovladat 8 klasickych modelarskych serv (generovani kladneho pulsu o delce 0,5-2,5ms, o frekvenci 50Hz) pres seriovou linku s (asi) ATmega8, rozliseni 1024 kroku.
Napadu, jak realizovat generovani ridiciho pulsu, jsem mel spoustu, v podstate prezily dva.
-vzit prijatou hodnotu pro servo 1, prepocitat strop pro citac, nastavit strop citace, nastavit vystup pro prvni servo na 1, zapnout citac, pri preruseni od citace vsechny vystupy na serva nastavit na 0, vzit prijatou hodnotu pro servo 2, prepocitat strop pro citac, nastavit strop citace, nastavit vystup pro druhe servo na 1, zapnout citac, pri preruseni vsechny vystupy na serva nastavit na 0...
to cele opakovat 50x za sekundu.
-podobne jako minule, pouzit opet citac nebo PWM, ale prepinat vystupy demuxem (a ten by sel mozna prepinat vystupem citace pri nabezne hrane signalu pro dalsi servo), mozna by se usetrilo trosicku casu, ale asi to nebude prilis vyznamne
Radsi bych pouzil prvni variantu. Ovsem nejak nedokazu do toho zakomponovat prijem dat. Rad bych mel data ve formatu 1byte adresa + 8x2byte poloha, s tim, ze adresni byte by treba mel MSB=0 a poloha by mela MSB=1 aby se to rozlisilo.
(ovladaci SW budu psat sam, takze format muze byt jiny)
Pri 9600Bd by melo trvat prenest 17bytu zhruba 16ms, coz je moc, nemuzu stravit 16ms pouze prijmem dat. Takze, co s tim?
Program bude v C, jsem zacatecnik, takze prosim poradte nejak srozumitelne.
Diky.
Iste to je mozne riesit aj softverovo, ako pise andrea, v tom pripade by som bral len hw uart. Keby si netrval len na AVR, tak mas vacsie moznosti, dnes ti vela vyrobcov posle cip gratis v ramci podpory vyvoja na ich platforme. Horsie je to s vyvoj.prostriedkami, ak nechces vrazat stovky eur do Jtagovych picislatok, tak sa vyber zuzuje, a ak zaradis kriterium free kompilatora C tak bude kandidatov zalostne, poznam jedineho, ale zatial mi staci na 90% aplikacii.
- Postavit INT_Timeru prioritně nad INT_UART
- INT_U obsluhuje příjem 1byte, čtení protokolu běží v mainu
- po úspěšném příjmu dat přepočítat hodnoty kanálů v mainu, když je hotovo, nastavit semafor a čekat na průlet INT_T, přestaví semafor a main zapíše nové hodnoty pro další cyklus (INT_T)
- perioda INT_T 50x za sec, max PWM pro servo je 10%
- v INT_T postupně čítat a komparovat. čím rychlejší algorytmus bude použitý, tím přesnější serva budou.
funguje to na 2051čce
- INT_U obsluhuje příjem 1byte, čtení protokolu běží v mainu
- po úspěšném příjmu dat přepočítat hodnoty kanálů v mainu, když je hotovo, nastavit semafor a čekat na průlet INT_T, přestaví semafor a main zapíše nové hodnoty pro další cyklus (INT_T)
- perioda INT_T 50x za sec, max PWM pro servo je 10%
- v INT_T postupně čítat a komparovat. čím rychlejší algorytmus bude použitý, tím přesnější serva budou.
funguje to na 2051čce
... aha, ale nefunguje to rozhodne s takovou presnosti.
V tom pripade bych asi serva bral postupne, tzn. prenastavoval dobu kdy bude dalsi INT_T.
Dejme tomu pointer "x" , ktery ukazuje na 1 z 8 kanalu, V INT_T bych pohnul s konkretnim pinem pwm kanalu (x) a nastavil periodu INT_T pr kanal (x+1).
Za poslednim kanalem budto konci a ceka na resetovaci INT_T2 (onech 50Hz), nebo se nastavi na zbylou dobu.
4-10% PWM s rozlisenim 10bit je docela dost.
Bych to spise videl na 8xDA s odpor. delicem 10% + generator pily + komparatory.
V tom pripade bych asi serva bral postupne, tzn. prenastavoval dobu kdy bude dalsi INT_T.
Dejme tomu pointer "x" , ktery ukazuje na 1 z 8 kanalu, V INT_T bych pohnul s konkretnim pinem pwm kanalu (x) a nastavil periodu INT_T pr kanal (x+1).
Za poslednim kanalem budto konci a ceka na resetovaci INT_T2 (onech 50Hz), nebo se nastavi na zbylou dobu.
4-10% PWM s rozlisenim 10bit je docela dost.
Bych to spise videl na 8xDA s odpor. delicem 10% + generator pily + komparatory.
a proč to neuděláš tak že nahodíš všechny výstupy do log1. vyčkáš 0,5ms a pak rozkrokuješ ty zbyvájící 2 ms do 1024 kroků. Počkáš tu určitou dobu a zkontroluješ zda se načítaná hodnota nerovná nějaký nastavený jenoho z výstupů. Pokud ano hodíš výstup do 0. Po projetí tech všech 1024 částí vyčkáš zbývajících 17,5ms. a takhle dokola. V tom zbývajícím čase by se dala vyřešit obsluha sériovýho portu.
nad tim jsem taky premyslel, ale na porovnavani vsech hodnoty by bylo jen 2us, to je jen 32 instrukci pri 16MHz, myslim, ze by to urcite nestihalo.
To uz by bylo asi lepsi nacist hodnoty, vzestupne je seradit, zapnout citac, povolit preruseni pri "compare A", do "A" vlozit nejnizsi hodnotu, pri preruseni zmenit "A" na druhou nejnizsi hodnotu, pokud budou 2 hodnoty blizko u sebe, nebo stejne, budou dalsi problemy.
uP mozna zase nebude stihat a kdyz by se vlozila hodnota nizsi, nez je aktualni stav citace, musel by dojet na konec a preruseni by bylo az v dalsim cyklu -> znacny problem.
To uz by bylo asi lepsi nacist hodnoty, vzestupne je seradit, zapnout citac, povolit preruseni pri "compare A", do "A" vlozit nejnizsi hodnotu, pri preruseni zmenit "A" na druhou nejnizsi hodnotu, pokud budou 2 hodnoty blizko u sebe, nebo stejne, budou dalsi problemy.
uP mozna zase nebude stihat a kdyz by se vlozila hodnota nizsi, nez je aktualni stav citace, musel by dojet na konec a preruseni by bylo az v dalsim cyklu -> znacny problem.
nevim jak je na tom mega s pamětí,
podle toho jak píše Ragnol, ale udělat 2 stránky po 1k a do ní vygenerovat mapu pro těch 8serv (8bitů - WRITE) pro 1024 časů (kroků).
Po těch 0,5ms tuhle mapu přenést (READ) autoinkrementační instrukcí - max. čas 2ms a tak dokola, dokud nepřijdou data a nevygeneruje se PWM mapa v druhé stránce. Potom stránky přepnout. (READ-WRITE)
podle toho jak píše Ragnol, ale udělat 2 stránky po 1k a do ní vygenerovat mapu pro těch 8serv (8bitů - WRITE) pro 1024 časů (kroků).
Po těch 0,5ms tuhle mapu přenést (READ) autoinkrementační instrukcí - max. čas 2ms a tak dokola, dokud nepřijdou data a nevygeneruje se PWM mapa v druhé stránce. Potom stránky přepnout. (READ-WRITE)
K.Pavel:
Použil bych první variantu z vaší pùvodní pošty.
Délka rámce impulsù pro serva bude promìnná, mezi cca 8 a 16 ms,
ale to by nemìlo vadit.
Na zaèátek by se ještì mìlo dát nastavení serv napø do støední polohy,
aby serva nešly za roh než pøijdou øídící bajty.
Použil bych první variantu z vaší pùvodní pošty.
Délka rámce impulsù pro serva bude promìnná, mezi cca 8 a 16 ms,
ale to by nemìlo vadit.
Kód: Vybrat vše
Pseudokód:
Byte num , temp 'èíslo serva (0 - 7)
Word_array cas(8) 'délka impulsu ( cas(0) - cas(7) )
Byte t1_flag 'pøíznak pøerušení timer1
Isr_timer1:
t1_flag = 1
Isr_uart_rx: 'pøíjem tøí bajtù
temp = Byte1 'èíslo serva
High(cas(temp)) = Byte2 'délka impulsu
Low(cas(temp))= Byte3
Main:
If t1_flag Then
Portb = 1 << Num 'zaèátek impulsu pro servo num, konec impulsu pøedešlého serva
Timer1 = 0x10000 - Cas(num) 'nastavení délky impulsu
If num = 7 Then num = 0 'pøiprav další servo
Else num = num + 1
End If
t1_flag = 0
End If
goto main
'Endmain
aby serva nešly za roh než pøijdou øídící bajty.