urdf fixes, going to use xacro