Inverterad Pendel [nu med film]
Tjena,
Har ni kollat in Quanser? De har en hel del coola grejer, t.ex 2DOF IP Video
Och sen finns det ju den här:
Tyvärr verkar det som att sidan med videoklipp med ovanstående robot inte ligger uppe längre men det finns en del på Youtube, sök på Ballbot.
/H.O
Har ni kollat in Quanser? De har en hel del coola grejer, t.ex 2DOF IP Video
Och sen finns det ju den här:
Tyvärr verkar det som att sidan med videoklipp med ovanstående robot inte ligger uppe längre men det finns en del på Youtube, sök på Ballbot.
/H.O
Hittade dessa när jag kollade på Ballbot.
http://www.youtube.com/watch?v=b3vDnwwB ... ed&search=
http://www.youtube.com/watch?v=V40ScvJe ... ed&search=
http://www.youtube.com/watch?v=b3vDnwwB ... ed&search=
http://www.youtube.com/watch?v=V40ScvJe ... ed&search=
Har kopplat in mitt motordrivkort och en motor (två är det förberett för) och gjort en första test med ett program som implementerar en enkel P-regulator (bara för att se att det rör sig som det ska).
Det verkar funka!! Lyckades få den att hålla pinnen balanserad en stund. Dock driver ju positionen på vagnen eftersom jag inte lagt till en encoder för hjulen ännu som ska användas för positionsbestämning.
Ska se om jag kan få upp någon film eller så....
Lite fakta:
- Kör regler loopen på 100 Hz. (dvs 10 ms per varv)
- Läser av AS5040 vinkel enkodern via SPI (mjukvaru SPI)
- Drar bort en vinkel offset så att 0 i vinkel ska mostvara rakt uppåt.
- Beräknar vinkelhastigheten (enhet [steg / 10ms])
- Beräknar kommenderad ström (P-regulator temporärt)
- Kommenderar strömmen
- Skickar ut debuginfo med 115200 bps seriellt.
- Kör än så länge via en "navelsträng" till en STK500 (till AS5040-kort och LMD18245-kort)
- Ca 6-7 % av looptiden används varav mestadelen är seriella kommunikationen (7 byte varje loop). Går att parallelisera med seriell interrupt om tiden blir knapp senare....
- Kör processorn på STK500 standard 3.6864 MHz, dvs kan speeda upp till 20 MHz om så skulle behövas....
Det verkar funka!! Lyckades få den att hålla pinnen balanserad en stund. Dock driver ju positionen på vagnen eftersom jag inte lagt till en encoder för hjulen ännu som ska användas för positionsbestämning.
Ska se om jag kan få upp någon film eller så....
Lite fakta:
- Kör regler loopen på 100 Hz. (dvs 10 ms per varv)
- Läser av AS5040 vinkel enkodern via SPI (mjukvaru SPI)
- Drar bort en vinkel offset så att 0 i vinkel ska mostvara rakt uppåt.
- Beräknar vinkelhastigheten (enhet [steg / 10ms])
- Beräknar kommenderad ström (P-regulator temporärt)
- Kommenderar strömmen
- Skickar ut debuginfo med 115200 bps seriellt.
- Kör än så länge via en "navelsträng" till en STK500 (till AS5040-kort och LMD18245-kort)
- Ca 6-7 % av looptiden används varav mestadelen är seriella kommunikationen (7 byte varje loop). Går att parallelisera med seriell interrupt om tiden blir knapp senare....
- Kör processorn på STK500 standard 3.6864 MHz, dvs kan speeda upp till 20 MHz om så skulle behövas....
Problemet med en tvåaxlad inverterad pendel är ju att infästningen som rör sig i ett plan kommer att hindra pendeln som roterar kring en punkt i detta plan. Den kommer alltså kunna slå i axlarna. Man kan tänka sig att det går att komma runt genom att pendla i 45 grader och kanske på något sätt förhindra detta. Två leder är ju annars roligt.
Nu har jag första FILMEN på den inverterade pendeln in action.
Dock med en enkel PD regulator och utan positionsåtermatning. Därav problemet att den driver både fram och tillbaka.
Men det kommer mera, som de säger!
Får spetsa koden med lite viagra så ska den nog stå stabilt... ...och en enkoder för positionen skadar nog inte heller!
Dock med en enkel PD regulator och utan positionsåtermatning. Därav problemet att den driver både fram och tillbaka.
Men det kommer mera, som de säger!
Får spetsa koden med lite viagra så ska den nog stå stabilt... ...och en enkoder för positionen skadar nog inte heller!
- JimmyAndersson
- Inlägg: 26308
- Blev medlem: 6 augusti 2005, 21:23:33
- Ort: Oskarshamn (En bit utanför)
- Kontakt:
- MicaelKarlsson
- Inlägg: 4669
- Blev medlem: 18 juni 2004, 09:16:07
- Ort: Aneby
- Kontakt:
Hjulen slirar när den kör som värst. Dock är huvudproblemet att jag inte har någon positionåterkoppling än. Eftersom jag kör med sladdar till STK500 måste jag ju "manuellt" se till att den inte sticker för långt och då är det lätt att den spårar ur, t.ex. när en fot är ivägen eller hur Jimmy . När den väl är stabil är accelerationen låg och då slirar den inte...
Har jobbat vidare med pendeln och fått den hyffsat stabil. Kommer väl lite uppdateringar framöver när tiden tillåter...
Till dess kan ju följande balanserande "pendel" vara roande att titta på...
Baby Balancing Act
Till dess kan ju följande balanserande "pendel" vara roande att titta på...
Baby Balancing Act