[Feature] ROS Wrapper with Action Server

[guilyx]

• A goal is received
• Controls are computed at frequency 1/dt until goal is reached
• Obstacles are detected using navigation2's costmaps