Initial import of GNGT-based shore tracking.
Merge branch 'master' of https://github.com/cedricpradalier/ros_kf_stack