From 7a8dba38a9f543544d192e821f2283cb8062c7a0 Mon Sep 17 00:00:00 2001
From: m-guberina <gubi.guberina@gmail.com>
Date: Tue, 10 Dec 2024 15:30:21 +0100
Subject: [PATCH] cm

---
 python/examples/.clik.py.swp                  | Bin 12288 -> 12288 bytes
 .../ur_simple_control/util/.get_model.py.swp  | Bin 32768 -> 32768 bytes
 python/ur_simple_control/util/get_model.py    |  12 ++----------
 3 files changed, 2 insertions(+), 10 deletions(-)

diff --git a/python/examples/.clik.py.swp b/python/examples/.clik.py.swp
index cfa969c37f3da44874ff263c98f9fbf4d98d91ac..1bb300c0a63b261bebb28545e734d0d9d4aa80aa 100644
GIT binary patch
delta 30
lcmZojXh;xEG6?hZRj|-AVqjok5MW@a@{dUG-YEK79{_jk2oC@N

delta 30
lcmZojXh;xEG6?hZRj|-AVqjok5MW>^^N&bx-zfT89{_i>2nPTF

diff --git a/python/ur_simple_control/util/.get_model.py.swp b/python/ur_simple_control/util/.get_model.py.swp
index 79d1d380f57f95e5f65f7229101507be08baf750..b26aa0f761f38c8893c849f32494045de31994d6 100644
GIT binary patch
delta 370
zcmZo@U}|V!5=t@%^Ym4)&@*CSU|<knU?>XMC}bzVXtg;|V6#5&J7xxkPb?4_tI2{6
z`SqP#3=GU%3=B+M3=EGr85kaNGB7ORWMHW0WMGKqWMDAhWMKHu!N72tgMr~72Lr=4
z4hDu^4h9Af4h9A}4hDuJ><kQ3*clj-*%=sQ*cli;vN13mV`E^L&Bnk`z{bGf&c?tX
z!^XfM&Bnm+i<N=lDk}rSY*q$_U{<h8)ELgOFfhzwVPME*VPLRgVPIflVPLq*%)qdU
znSr64nSsHRnStToW>v>4jFXF;11FzxN|;>ktUY<5i`e7>GjS*_$KvJh=?CS=PA+%W
zg|Ho+Ahem><lf|8lhsXxCKsggOqM7!n_T4zVV^4Fom^!hG&v!SZ?bK<+2$%&J;ur5
l9s--|GS@Lqe(f2-8lPB{TRi!om-^%^uW$%&^Fc3rQvh^!T!#Pv

delta 280
zcmZo@U}|V!5=t@%^Ym4)&@*CSU|<knU@-UJC}bzV=(IUdV6#4NFcSkqIWt7YX|kY0
zetjPo0|PG?0|O5i1H&6m28P$13=Hcy85lY_85mMI85pcM85lS@85r(zFfg3vU|=}F
z!N4$`gMlH4gMmSVgMr}}I|IWpb_Rx-><kQP><kQg><kQy><kRo*cccVvoSDuvN147
zvN15cU}a!f$jZP_#>&9p&C0-_z{<ezm4!i#;S37{!$KAYh6OAP4D~Dw3{fl$3<@j^
z3^$k|PIX~sVEDON)$t1B<Z@@@$vw%Elg~KSZMJiL%CtGJ(t~;OGtb~jO3{;NdMQs*
YQlGp)No%s0m*D1WN}-IKD||YP0g~D|XaE2J

diff --git a/python/ur_simple_control/util/get_model.py b/python/ur_simple_control/util/get_model.py
index 5dd857d..1406e1f 100644
--- a/python/ur_simple_control/util/get_model.py
+++ b/python/ur_simple_control/util/get_model.py
@@ -182,8 +182,8 @@ def get_yumi_model():
     # in case pinocchio people decide to change their api.
     #model, collision_model, visual_model = pin.buildModelsFromUrdf(urdf_path_absolute, mesh_dir_absolute)
     model_arms = pin.buildModelFromUrdf(urdf_path_absolute)
-    visual_model_arms = pin.buildGeomFromUrdf(model, urdf_path_absolute, pin.GeometryType.VISUAL, None, mesh_dir_absolute)
-    collision_model_arms = pin.buildGeomFromUrdf(model, urdf_path_absolute, pin.GeometryType.COLLISION, None, mesh_dir_absolute)
+    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)
 
@@ -198,14 +198,6 @@ def get_yumi_model():
     joint_placement = pin.SE3.Identity()
     #joint_placement.rotation = pin.rpy.rpyToMatrix(0, -np.pi/2, 0) 
     #joint_placement.translation[2] = 0.2
-    # TODO TODO TODO TODO TODO TODO TODO TODO
-    # TODO: heron is actually a differential drive,
-    # meaning that it is not a planar joint.
-    # we could put in a prismatic + revolute joint
-    # as the base (both joints being at same position),
-    # and that should work for our purposes.
-    # this makes sense for initial testing
-    # because mobile yumi's base is a planar joint
     MOBILE_BASE_JOINT_ID = model_mobile_base.addJoint(parent_id, pin.JointModelPlanar(), 
             joint_placement.copy(), joint_name)
     # we should immediately set velocity limits.
-- 
GitLab