Harmonize doxygen tags
Use message filter
Increase resolution (for testing)

Will set up dynamic reconfigure later