- Publish everything from MCU, filter on host side
- Save debug plots along with storage options.
- Refactor / modularize FBWR controller code, it's a long mess
- add publishers for calculated lowest timestamps, distances, fit parameters
- For Contribution 2!!!: https://stackoverflow.com/questions/77134139/fit-3d-cylinder-in-a-point-cloud
- https://stackoverflow.com/questions/43784618/fit-a-cylinder-to-scattered-3d-xyz-point-data/44164662#44164662