Close
0%
0%

Robot pokonujący kanion

Projekt realizowany w ramach kursu Podstawy Mechatroniki na Akademii Górniczo-Hutniczej im. Stanisława Staszica w Krakowie.

Public Chat
Similar projects worth following
Projekt zrealizowany w ramach zajęć z Podstaw Mechatroniki w roku akademickim 2020/2021.
Robot ma za zadanie pokonać przepaść. Po podjechaniu do krawędzi ocenia, czy będzie w stanie pokonać daną odległość, a następnie pokonuje ją lub anuluje próbę przejazdu. Model składa się z 1562 części.

Opis działania robota

rys. 1 uproszczony model robota
                                                                  rys. 1 uproszczony model robota

Jako pierwszy uruchamia się algorytm pozycji startowej:

Algorytm ustawienia pozycji startowej

Silnik (B) podnosi most do momentu, gdy krańcówka (4) wykryje most. Następnie silnik (B) zatrzymuje swoją pracę, a silnik (C) przesuwa most w lewo do czasu, kiedy krańcówka (1) wykryje podporę.

Algorytm główny

Jako pierwszy uruchamia się silnik (A) w celu podjazdu do krawędzi. Gdy czujnik (2) wykryje przepaść, silnik (A) zatrzymuje swoją pracę. W tym momencie silnik (C) rozpoczyna swoją pracę i przesuwa most w prawo jednocześnie licząc wykonane obroty (n) . Przeliczenie obrotów na odległość kanionu (d) jest wyrażone wzorem: d = 2nπR.  Następnie możemy wyróżnić trzy przypadki, które mogą wystąpić:

1. Czujnik (3) wykrywa przeciwległą krawędź. Silnik (C) się zatrzymuje. Jeżeli l-d > 2p, to silnik (C) wysuwa most o odległość p, następnie silnik (B) opuszcza most licząc obroty. Po opuszczeniu mostu silnik (C) uruchamia się, następuje przejazd robota po moście, dopóki krańcówka (1) nie wykryje podpory. Wówczas praca silnika (C) zostaje wstrzymana, silnik (B) opuszcza robota o wcześniej zliczoną liczbę obrotów. Algorytm uruchamia się od nowa.

2. Algorytm przebiega analogicznie jak w pierwszym punkcie, jednak w momencie, gdy zostaje zatrzymana praca silnika (C) wartość l-d <= 2p. Wówczas silnik (C) wsuwa most z powrotem o wcześniej policzoną ilość obrotów, zostaje wykonany algorytm anulowania akcji. Program się kończy.

3. Algorytm przebiega analogicznie jak w pierwszym punkcie, jednak w momencie, gdy silnik (C) przesuwa most w prawo, jednocześnie licząc obroty, czujnik (3) nie wykrywa przeciwległej krawędzi. Wówczas zostaje zastosowany algorytm anulowania akcji oraz algorytm ustawienia pozycji startowej

Algorytm anulowania akcji

Silnik podjazdowy (A) cofa robota. Uruchamia się algorytm ustawienia pozycji startowej. Program się kończy.

Schematy blokowe działania algorytmu można znaleźć w plikach.

Układ mechaniczny

Projekt robota został podzielony na cztery zasadnicze części:

  • podwozie,
  • podnośnik,
  • część przejazdowa,
  • most.

Do realizacji naszego robota zastosowaliśmy trzy silniki.

Podwozie napędza jeden silnik, przy którym zastosowano przekładnie 3:5, w celu zwiększenia momentu obrotowego tylnej osi. Do obsługi podnośnika również zastosowano przekładnie redukcyjna o i = 1:3. Zespół konstruujący część przejazdową robota, po wnikliwej analizie, wybrał przekładnie 1:1.

Silnik napędzający podwozie został zamontowany z tyłu podwozia oraz prostopadle do płaszczyzny przejazdu, w celu odpowiedniego rozmieszczenia masy w układzie oraz w celu łatwiejszej aplikacji sensorów w przedniej części podwozia.

Artykuły szczegółowo opisujące każdą z części mechanicznych można znaleźć w plikach.

Układ elektroniczno-sensoryczny oraz rozwiązania informatyczne

Do wykonania projektu wybrano moduł sterujący i sensory z serii Lego Mindstorms NXT.

Sensory rozmieszczono tak, jak na rysunku 1:

  • Czujnik (1) - krańcówka; wykrywa moment, w którym podwozie dojeżdża do podpory mostu,
  • Czujnik (2) - czujnik ultradźwiękowy; w momencie, w którym robot podjeżdża do przepaści, wysyła sygnał, aby rozpocząć algorytm pokonywania przepaści,
  • Czujnik (3) - czujnik ultradźwiękowy; odpowiada za wykrycie przeciwległej krawędzi,
  • Czujnik (4) - krańcówka; wykrywa moment, w którym silnik powinien przestać podnosić most....
Read more »

Animacja robot pokonujacy kanion.avi

przykladowa animacja 2

Audio Video Interleave (AVI) - 28.40 MB - 05/28/2021 at 14:41

Download

Animacja 1.avi

Przykładowa animacja

Audio Video Interleave (AVI) - 26.07 MB - 05/28/2021 at 14:13

Download

Artykuł informatyczny.pdf

Adobe Portable Document Format - 534.23 kB - 05/28/2021 at 13:35

Preview

Tablica_morfologiczna_informatyka.pdf

Tablica morfologiczna - część informatyczna.

Adobe Portable Document Format - 35.31 kB - 05/28/2021 at 13:34

Preview

dokumentacja_techniczna.pdf

Dokumentacja techniczna całego robota.

Adobe Portable Document Format - 3.44 MB - 05/28/2021 at 12:26

Preview

View all 10 files

View all 4 instructions

Enjoy this project?

Share

Discussions

Similar Projects

Does this project spark your interest?

Become a member to follow this project and never miss any updates