Budżetowy manipulator 6DOF: od kinematyki do optymalizacji konstrukcji
Alternatywy z ograniczonym budżetem: silniki krokowe bez sprzężenia zwrotnego lub inteligentne serwomotory z magistralą TTL/RS485. Wybrane serwomotory Feetech STS3215 za cenę 15–30 USD, ważą 55 g i umożliwiają połączenie w szeregu (daisy-chain).
Klasyczna antropomorficzna konfiguracja jest niemożliwa: moment M = F × L = 1 kg × 9,81 m/s² × 0,65 m ≈ 65 kg·cm przekracza możliwości serwomotorów (15 kg·cm). Rozwiązanie: pół-SCARA:
- Oś Z pionowa — przekładnia śrubowo-rolkowa (jak w drukarkach 3D).
- Część SCARA pozioma — ogniwa bez obciążenia grawitacyjnego na napędy.
- Przedramię z chwytakiem dla 6 stopni swobody.
Prototypowanie rozpoczęto od zestawu Lego Technic do sprawdzenia koncepcji, następnie stworzono modele CAD.
Kompensacja luzu parą serwomotorów
Luz w tanich serwomotorach wynosi 0,8° (przeciwko deklarowanym <0,5°). Na ramieniu 650 mm daje to odchylenie liniowe ok. 9 mm na jednym joint, całkowity błąd pozycjonowania >1 cm.
Rozwiązanie: dwa serwomotory na oś z naciągiem (preload) — jeden działa w kierunku zegara, drugi przeciwnie. Backlash zostaje wyeliminowany, ale wzrasta tarcie i zużycie reduktora przy dużych obciążeniach. Idealne dla umiarkowanych zadań.
Pomiary na specjalnym stanowisku: gumka zapewnia minimalny naciąg bez deformacji. Metodologia opisana w recenzowanej pracy HardwareX.
Model CAD węzła pokazuje pary serwomotorów dla osi prostopadłych w zwartej kompozycji. Testowy montaż z akrylu i blachy potwierdził działanie pod obciążeniem.
Optymalizacja konstrukcji i kosztów
Pierwsza wersja: 46 detali zamówionych (laser, CNC, tokarka), koszt produkcji ~1500 USD. Uproszczona do 6 elementów: profile aluminiowe, sztywna struktura. BOM — 452 USD (detale + wysyłka z Chin), razem 900 USD.
Warianty uproszczenia:
- Minimalna liczba elementów (np. Aharobot) — kompromis ze sztywnością.
- Wersja sztywna z zachowaniem pół-SCARA.
Optymalizacja topologiczna elementów nośnych:
| Parametr | Pierwotny | Po optymalizacji | Poprawa |
|----------|----------|-------------------|---------|
| Masa | 1,937 kg | 2,376 kg | +22% |
| Maks. naprężenie | 93 MPa | 25 MPa | ↓3,7 razy |
| Odchylenie Y | 1,05 mm | 0,41 mm | ↓2,5 razy |
| Odchylenie X | 1,03 mm | 0,31 mm | ↓3,3 razy |
| Odchylenie Z | 0,62 mm | 0,21 mm | ↓3,0 razy |
Zwiększenie masy o 22% spowodowało zmniejszenie naprężeń o 3,7 razy i odchyleń o 2,5–3,3 razy. Ostateczny prototyp ma organiczne elementy sztywności.
Ostateczny montaż i zastosowanie
Konstrukcja: 11 serwomotorów + 1 silnik krokowy, numeracja napędów w modelu CAD. Testowanie — stanowiska z obciążeniem, nagrania ruchu węzłów.
Skalowanie: stolik z 4 manipulatorami, integracja z platformami mobilnymi. Idealne do badań naukowych w zakresie uczenia przez podobieństwo bez wydatków 19–30 tys. USD na komercyjne odpowiedniki (Aloha, Agilex).
Co ważne:
- Pół-SCARA zmniejsza moment na podstawowe napędy z 65 kg·cm do dopuszczalnych wartości.
- Para serwomotorów kompensuje luz 0,8°, błąd pozycjonowania <1 cm.
- Optymalizacja BOM: z 1500 USD do 900 USD, liczba detali z 46 do 6.
- Optymalizacja topologiczna: naprężenia ↓3,7 razy, odchylenia ↓2,5–3,3 razy.
- Feetech STS3215 — podstawa DIY 6DOF z 12-bitowym enkoderem i magistralą TTL/RS485.
— Editorial Team
Brak komentarzy.