adds separate publisher for ground plane and some small improvements