fix control law for circle around
add velocitySaturation function
remove deprecated functions
Merge branch 'fuerte' of github.com:damien-petit/navigation_to_object into fuerte
Merge branch 'fuerte' of github.com:damien-petit/navigation_to_object into fuerte
merge to add coshell
fix velocitySaturation