Unified scan publisher

Again activated. It's still using tf. I started to port it to tf2 and because of that there are add header files for tf2.