- Change Control flow?
- Stop PID
- clearcostmap (confirm with actual service)
- change pid mode
- store goals
- send goal
- cancel goal
- home
- rumble feedback
- goal status for micro ros
- Remove not required libs
- Test on sim/robot
- [Bug] Delay observed when home pose and cancel goal log