Remove all submodules
Use catkin to handle dependency to jrl-mathtools