Description for the assignment: http://www-cvr.ai.uiuc.edu/~seth/Teaching/ece550/sp16/docs/p-hwk3
Guidelines: https://sites.google.com/site/rosassignment3
To install youBot packages, and robot controllers for ROS checkout this link below:
https://sites.google.com/site/rosassignmentii/youbot
The source code: ./src/rrt_youbot_node.cpp
The launch file: ./launch/test_youbot.launch
Matlab scripts: RRT: ./matlab/rrt_connect_test/, Forward kinematics (youBot): ./matlab/kuka_youbot_kinematics/
Used the source code for Dijkstra's algorithm from the following link (geeksforgeeks):
http://www.geeksforgeeks.org/greedy-algorithms-set-6-dijkstras-shortest-path-algorithm/