diff --git a/python/ur_simple_control/util/.get_model.py.swp b/python/ur_simple_control/util/.get_model.py.swp index b26aa0f761f38c8893c849f32494045de31994d6..211a917f313e7c947709a4dce0ae1517672a931b 100644 Binary files a/python/ur_simple_control/util/.get_model.py.swp and b/python/ur_simple_control/util/.get_model.py.swp differ diff --git a/python/ur_simple_control/util/get_model.py b/python/ur_simple_control/util/get_model.py index 1406e1fdaa591d1e6daa70d6b01307507cc29bdc..1b088c6fb6652603b1fa3000fae720df099e807e 100644 --- a/python/ur_simple_control/util/get_model.py +++ b/python/ur_simple_control/util/get_model.py @@ -185,7 +185,7 @@ def get_yumi_model(): visual_model_arms = pin.buildGeomFromUrdf(model_arms, urdf_path_absolute, pin.GeometryType.VISUAL, None, mesh_dir_absolute) collision_model_arms = pin.buildGeomFromUrdf(model_arms, urdf_path_absolute, pin.GeometryType.COLLISION, None, mesh_dir_absolute) - data_arms = pin.Data(model) + data_arms = pin.Data(model_arms) # mobile base as planar joint (there's probably a better # option but whatever right now) @@ -226,6 +226,8 @@ def get_yumi_model(): # frame-index should be 1 model, visual_model = pin.appendModel(model_mobile_base, model_arms, geom_model_mobile_base, visual_model_arms, 1, pin.SE3.Identity()) + data = model.createData() + return model, visual_model.copy(), visual_model, data