Removing urdf_parser_py hack stuff