Projekt

Ogólne

Profil

Lab3 » Historia » Wersja 4

Wersja 3 (Dawid Seredyński, 2018-06-13 17:02) → Wersja 4/8 (Dawid Seredyński, 2018-06-13 17:08)

h1. Lab 3: Forward kinematics

h2. Scope:

This laboratory consist of two parts:

* A short introduction.
* Writing your own ROS package.

h2. The task:

* Develop the system from the previous laboratory by either copying the package or modyfying it.
* Using C++ or Python create a ROS node NONKDL_DKIN that calculates forward kinematics of manipulator using analytical method (without KDL).

* The node gets current position of joints from joint_state_publisher node.
* The result (i.e. position of end effector of type geometry_msgs/PoseStamped) should be published on ROS topic and visualized in RVIZ.
* Do not interpolate movement.
* Please refer to RVIZ documentation http://wiki.ros.org/rviz/Tutorials
* Read parameters (e.g. lengths of links) from ROS parameter server.
!https://www.robotyka.ia.pw.edu.pl/redmine/attachments/download/203/lab3-scheme-a.png(graph a: ROS nodes for ANRO laboratory 3)!
* Create a second node Tworzymy drugi, analogiczny węzeł KDL_DKIN that uses KDL, with the same functionality as NONKDL_DKIN. z użyciem KDL

* Connect it to existing nodes in place of NONKDL_DKIN. podłączamy go do istniejących węzłów tak samo jako węzeł rozwiązujący prostą kinematykę bez użycia KDL
!https://www.robotyka.ia.pw.edu.pl/redmine/attachments/download/204/lab3-scheme-b.png(graph b: ROS nodes for ANRO laboratory 3)!
* Test the results in RVIZ. Compare nodes Testujemy rozwiązanie w programie RVIZ, zestawiając działanie dwóch autorskich węzłów NONKDL_DKIN and i KDL_DKIN using data generated by z manipulatorem wizualizowanym na podstawie danych dostarczanych z robot_state_publisher.
* Check if the calculated pose is the same as the pose calculated by ROS tf. Compare both poses in Sprawdzamy zgodność pozycji końcówki manipulatora z poszczególnym węzłów, odczytując pozycje w programie RVIZ.
* Warto zwrócić uwagę, że wszystkie 3 węzły obliczające prostą kinematykę powinny publikować na oddzielnych tematach, choć dwa z nich korzystają z tego samego typu wiadomości.
* Układy współrzędnych związane z końcówką mogą (a nawet powinny) być zgodne co do położenia i orientacji. Warto manipulować parametrami ich wyświetlania (długością i grubością strzałek) tak, żeby były widoczne i się nie przysłaniały.
* Testy uzupełniamy wydrukami położenia w przestrzenie konfiguracyjnej i operacyjnej. Testy te tradycyjnie należy zamieścić w dokumentacji.
!https://www.robotyka.ia.pw.edu.pl/redmine/attachments/download/205/lab3-scheme-c.png(graph c: ROS nodes for ANRO laboratory 3)!
* W rozszerzonym wariancie zadania należy uwzględnić ograniczenia kinematyki co do zakresu ruchu stawów.
* w szczególności jeżeli wyznaczenie położenia nie jest możliwe, węzły liczące kinematykę nie powinny publikować nowych pozycji zadanych oraz mają sygnalizować błąd w ROS log
* W ramach repozytorium na serwerze GitHub z własnym pakietem dodajemy wiki z opisem plików źródłowych, instrukcją jak uruchomić system opisany w pliku roslaunch oraz przebiegiem testów.
* Podczas pracy z systemem właściwe jest wydzielenie pliku roslaunch, który będzie uruchamiany jako pierwszy w dedykowanej konsoli włączając roscore oraz RVIZ. Ta część systemu zasadniczo nie powinna być wyłączana, o ile nie jest modyfikowany plik URDF.
* Pozostała część systemu sterowania powinna być uruchamiana w oddzielnym pliku roslaunch.
* Testujemy system i przedstawiamy prowadzącemu do oceny.