adds separate publisher for ground plane and some small improvements
Merge branch 'ground_plane_pub'

Conflicts:
	CMakeLists.txt