This repository contains my personal catkin workspace. It has lots of testing packages and some garbage too.
To review the final version of the algorithm, please refer to this link.
The complete work explanation, examples and results can be found in the project's final document.