Missing rviz configs
Clean up xacro files
Add debug action