LinkedIn YouTube Facebook
Szukaj

Wstecz
Artykuły

[PROJEKT] Prosty robot z czujnikiem odległości Sharp GP2Y0D810Z0F

W projekcie zrealizowany jest prosty robot mobilny. Jest on oparty na płytce rozwojowej KA-NucleoF411CE z mikrokontrolerem SMT32. Wykorzystuje również czujnik odległości, aby uniknąć zderzenia z przeszkodą.

Do zrealizowania projektu potrzebne są:

W projekcie jest wykorzystany program z artykułu Sterowanie silnikami – KA-Nucleo-F411CE oraz shield z układem L298, dlatego warto się z nim zapoznać przed przystąpieniem do programowania robota z tego artykułu.

Podstawę dla naszego robota stanowi podwozie 2WD Robot Car. To zestaw do samodzielnego montażu, który zawiera elementy konstrukcyjne wykonane z przezroczystej plexi, dwa silniki prądu stałego z kołami o średnicy 65 mm, dwa kółka podporowe oraz koszyk na 2 baterie AA. W zestawie znalazły się również odpowiednie śrubki oraz dystanse potrzebne do złożenia podwozia. Po złożeniu podwozie 2WD Robot Car prezentuje się następująco:

Rysunek 1. Złożone podwozie 2WD Robot Car 

Górny element podwozia posiada liczne otwory, które ułatwiają montaż różnych elementów. Na szczycie podwozia znajduje się płytka KA-Nucleo-F411CE. Akumulator Li-Pol umieszczony jest niżej. Po montażu elementów robot prezentuje się następująco:

 

Rysunek 2. Podwozie z zamontowaną płytką KA-Nucleo-F411CE i sterownikiem silników 

Ostatnim elementem jest cyfrowy czujnik odległości Sharp (GP2Y0D810Z0F), który pozwala wykrywać przeszkody w odległości 2…10 cm. Czujnik ma wyjście cyfrowe. Domyślnie na jego wyjściu jest stan wysoki, jednak gdy przed czujnikiem pojawi się jakiś obiekt, na wyjściu pojawia się stan niski. Sensor wykorzystuje światło podczerwone do wykrywania obiektów. Do podwozia przymocowany jest za pomocą mocowania wydrukowanego na drukarce 3D (plik znajduje się w sekcji „do pobrania”), można go również zamocować w inny sposób, np. wykorzystując dwustronną taśmę klejącą. Czujnik jest zamontowany z przodu podwozia jak na rysunku 3.

Rysunek 3. Czujnik odległości zamontowany na podwoziu

Gdy wszystkie elementy znajdują już się na podwoziu, musimy podłączyć czujnik odległości do KA-Nucleo-F411CE zgodnie z tabelą poniżej:

Pin KA-Nucleo Czujnik odległości
5V 5V
GND GND
D2 OUT

Po podłączeniu czujnika odległości całość prezentuje się następująco:

Rysunek 4. Gotowa konstrukcja „robota”

Autor: Patryk Mądry