TestPublisher visualization

- corner visualization
- center of mass visualization