Here is the code implementing the first assignment of our project. You can find the src folder for the catkin workspace.
ℹ For any further information, read the paper: Robotics_Project.pdf, or refer to the repository's README.
Watch the video of the simulation