Sauce cleanup

I really don't think that the ground avoidance stuff should be here. This is the dumb version and a proper version would be much more complex. Create a separated auv_ground_following package for that.