moved poi to test-publisher and some color-changes in rviz