Added velocity estimate (not working) in gngt
Added mission with reference follow shore with new planner
Added service in TaskFollowShore