working ros-control and diagnostics
Setup robot_localization