Fixed missing things
Prepared ground_plane_estimation for release.