- [x] Create a *_ros package - [x] Add nodes for calculation here - [x] Add nodes for publishing visualization mshs