To jest stara wersja strony!
Opis
Spotkania
08.02.26
08.03.04
080318
Po namyśle: zdecydowanie chcemy, żeby Pana program docelowo chodził pod linuxem i windows.
Kwestie otwarte to:
080409
080422
080520
Projekt
prolog
|
v
socket --> socket
|
v
brixcc
|
v
BT/USB
|
V
NXT
Sprawozdanie
Zostal napisany kod w jezyku C, ktory z uzyciem nxtpp pozwala na sterowanie robotami mindstorms.
Kod dziala w ten sposob, ze wystawia na socket (na wybranym porcie) polaczenie, ktore oczekuje na polaczenia od klientow. Po zainicjalizowaniu polaczenia, klient przesyla polecenia, ktore maja zostac wykonane przez robota. Na potrzeby komunikacji serwer <-> klient zostal stworzony i zaimplementowany stosowny protokol (ponizej jego opis) wedlug ktorego nastepuje komunikacja.
Zrodla projektu: {{:pl:miw:mindstorm_control_c.zip mindstorm_control_c.zip}}
===== Opis protokolu =====
==== NXT modul: ====
== Possible commands: ==
^ command ^ return ^ description ^
| nxt; open | — | Initiates the NXT connection |
| nxt; close | — | Closes the NXT connection|
| nxt; batteryLevel | value | Returns the current battery level |
| nxt; getName | value | Gets the name of the NXT |
| nxt; startProgram; name | — | Starts a program on the NXT with a specified name|
| nxt; stopProgram | — | Stops the current program if one is running |
| nxt; playTone | — | Plays a tone |
| nxt; playSoundFile; name, loop | — | Plays a sound file on the NXT with a specified name|
| nxt; stopSound | — | Stops the currently playing sound|
Description arguments:
* loop: TRUE, FALSE
Possible replies:
* ok
* ok: [what]
* err
* err: not_enable_interface
* err: unknown_module: [what]
* err: unknown_command: [what]
* err: wrong_params: [what]
==== Motor modul: ====
== Possible commands: ==
^ command ^ return ^ description ^
| motor; getRotationCount; portNr | value|motor; getRotationCount; portNr |
| motor; resetRotationCount; portNr; relative | — | Resets the specified motor's rotation count |
| motor; setForward; portNr; power | — | Sets a motor to turn forward at a specified power |
| motor; setReverse; portNr; power | — | Sets a motor to turn backward at a specified power |
| motor; stop; portNr; brake | — | Tells a motor to stop turning |
| motor; breakOn; portNr | — | Tells a motor to turn the brake on |
| motor; breakOff; portNr | — | Tells a motor to turn the brake off |
| motor; goTo; portNr; power; tacho; brake | — |Tells a motor to go to a certian angle and then stop |
Description arguments:
* portNr: IN_1, IN_2, IN_3, IN_4
* active: TRUE, FALSE
* interval: miliseconds
Possible replies:
* ok
* ok: [what]
* err: not_enable_interface
* err: unknown_module: [what]
* err: unknown_command: [what]
* err: wrong_params: [what]
==== Sensor modul: ====
== Possible commands: ==
^ command ^ return ^ description ^
| sensor; setTouch; portNr | — | Sets a sensor in a specified port to a touch sensor |
| sensor; setSound; portNr | — | Sets a sensor in a specified port to a sound sensor |
| sensor; setLight; portNr, active | — |Sets a sensor in a specified port to a light sensor |
| sensor; setSonar; portNr | — | Sets a sensor in a specified port to a sonar sensor |
| sensor; setRaw; portNr | — | Sets a sensor to return a raw value |
| sensor; getValue; portNr | value | Retrieves the value of a sensor |
| sensor; lsGetStatus; portNr | value | Gets the status of the lowspeed port |
| sensor; getSonarValue; portNr | value | Retrieves the value for sonar sensors |
| sensor; setSonarOff; portNr | — | Tells the sonar sensor to stop sending pulses |
| sensor; setSonarSingleShot; portNr | — | Tells the sonar sensor to only send a pulse when you ask it what it's value is |
| sensor; setSonarContinuous; portNr | — | Tells the sonar sensor to continuously send pulses |
| sensor; setSonarContinuousInterval; portNr, interval | — | Sets the interval at which the sonar sensor sends a pulse |
Description arguments:
* loop: TRUE, FALSE
Possible replies:
* ok
* ok: [what]
* err: not_enable_interface
* err: unknown_module: [what]
* err: unknown_command: [what]
* err: wrong_params: [what]
===== =====
Wstepne testy wykazaly poprawnosc dzialania kodu (przetestowane funkcje dzialaly zgodnie z zalozeniami i potrafily wykonywac rozne operacja z wykorzystaniem robota).
Kod zostal napisany pod Linuxem z wykorzystaniem socketow dostarczanych przez ten wlasnie system. W zwiazku z koniecznoscia dzialania kodu takze na systemach rodziny windows dokonano prob uruchomienia napisanego kodu z wykorzystaniem srodowisk Cygwin i MinGW. W obu przypadkach proby zakonczyly sie niepowodzeniem. Nawet maksymalna ilosc dostepnych pakietow w srodowisku Cygwin nie pozwolila na uruchomienie kodu. Powodem byl problem z kompilacja bliblioteki nxtpp (bylo to niemozliwe zarowno za pomoca linkowania zbudowanych bibliotek *.lib dla windows jak i niepowodzeniem konczyla sie proba zbudowania samych pakietow nxtpp).
W zwiazku z powyzszym, aby mozna bylo uruchamiac kod zarowno na systemach linux jaki i windows postanowiono przepisac czesc kodu odpawiadajaca komunikacji sieciowej, z wykorzystaniem najnowszej wersji biblioteki asio boost'a (www.boost.org) - w trakcie realizacji.
===== =====
Dokonano modyfikacji czesci kodu odpowiadajaca za komunikacje sieciowa. Zgodnie z zalozeniami zostala wykorzysta biblioteka boost'a ASIO. Dzieki temu kod jest w pelni przenosny. Na chwile obecna zostaly wykonane testy dla systemow Linux i windows, ktore potwierdzaja poprawnosc dzialania kodu.
===== =====
Usunieto wszytkie znalezione bledy/niedorobki, glownie zwiazane z obsluga samych bledow. Zostaly dodane tez funkcje escapujace znaki CR/LF (13/10) co umozliwia wykorzystanie jako klienta zwyklego telnetu. Na systemach z rodziny windows radzi sie wykorzystanie programu 'putty', gdzie rzecz jasna jako 'Connection type' wybieramy 'RAW' (socket). W systemach unixowych doskonale sprawuje sie zwykly telnet (przetestowano).
Zrodla projektu (ver. 2) mindstorm_control_c_ver.2.zip
===== =====
OPIS KOMPILACJI
Przygotowanie srodowiska:
Potrzebujemy dwoch bibliotek:
NXT ktora mozemy sciagnac tutaj.
Pelny opis przygotowania srodowiska by moc uzywac tej biblioteki znajdziemy:
-
[linux] makefile (oczywiscie uprzednio go edytujac - nalezy podac informacje o polozeniu headerow dla nxt
oraz (w zaleznosci od sposobu wykonania pierwszego etapu) ewuntualnie sciezki do ASIO boost'a).
===== =====
**Binarki**
* [windows] {{:pl:miw:nxt.zip nxt.zip}} (zbudowano na Windows XP SP2)
* [linux] nxt.tar.gz (zbudowano na Debian 4.0 R3) Jesli nie instalowano uprzednio ASIO boosta z pewnoscia bedziemy musieli wykorzystac zalaczona biblioteke do uruchomienia binarki. Najlepiej ja przeniesc w stand. miejsce wszystkich bibliotek czyli pewnie do /usr/lib/.
Binarki - wersja 3.
* [windows] nxt2.zip
* [linux] nxt2.tar.gz
===== =====
Przyklad uzycia
* laczymy sie np. przez telnet na porcie 2056 (oczywiscie IP stosowny do sytuacji; na cele przykladu zaklada sie lokalne odpalenie serwera), czyli wpisujemy: 'telnet localhost 2056'
* na poczatku musimy sie polaczyc z robotem, wydajemy wiec polecenie: 'nxt; open'
* pozniej wszystkie inne polecenia, ktore zrobia z robotem wszystko czego zapragniemy ;)
* na samym koncu zeby sie rozlaczyc z robotem wydajemy polecenie 'nxt; close'
* i rozlaczanie z samym serwerem realizujemy za pomoca polecenia: 'bye'
===== =====
Kolejna, trzecia wersja
W nowej wersji dokonano niewielkich modyfikacji czesci kodu, na rzecz usuniecia znalezionych niedopatrzen.
Wieksza czesc pracy nad ta wersja poswiecono na dodanie pewnej funkcjonalnosci na potrzeby integracji z Prologiem (klient napisany w Prologu).
* Zrodla (wersja 3): mindstorm_control_c_ver.3.zip
===== =====
Klient w prologu
Kolejnym etapem byla integracja napisanego uprzednio kodu, z klientem, ktory mialby sie laczyc z naszym serwerem i na rzecz ktorego serwer wykonywalby zadane operacje. API calosci napisal kolega, Piotr Hołownia, moim zadaniem bylo napisanie tresci (klienta) w Prologu.
Dokonano wiec implementacji zadanych instrukcji, ktore komunikuja sie z poziomu Prologu za pomoca socketow z programem napisanym w C.
-
BT pod win
Z wykorzystaniem NXT++ istnieje mozliwosc polaczenia z robotem nie tylko za pomoca USB, ale takze przez BT.
W celu polaczenia przez BT (wczesniej juz zparowanego) wystarczy wywolac funckcje OpenBT(). W przypadku kiedy chcemy zdecydowac z poziomu kodu o parowaniu konkretnego robota musimy uzyc odpowiednich funkcji:
iNXT::pairBluetooth( ViConstString resourceName, ViConstString passkey, ViChar pairedResourceName[], tStatus& status );
iNXT::unpairBluetooth( ViConstString resourceName, tStatus& status );
iNXT::isPaired( ViConstString resourceName, tStatus& status );
Materiały
