The dynamic state publsiher and the urdf management should work now but still need some testing