From 7924118dd14a2cd21506a512b4264baa83afeeb6 Mon Sep 17 00:00:00 2001
From: m-guberina <gubi.guberina@gmail.com>
Date: Tue, 10 Dec 2024 16:32:46 +0100
Subject: [PATCH] cm

---
 python/examples/.cart_pulling.py.swp | Bin 32768 -> 32768 bytes
 python/examples/cart_pulling.py      |   1 +
 2 files changed, 1 insertion(+)

diff --git a/python/examples/.cart_pulling.py.swp b/python/examples/.cart_pulling.py.swp
index 71408b9b7087f65ed9fe6b5d1f62aec4aa34e49c..d083bfd1f0f0bb8d4c446be27b520c46e1d86836 100644
GIT binary patch
delta 308
zcmZo@U}|V!+7KYX=(9OcV6#3iKLZ0pG$R88g8&1A&tyS|=z0wv28OfT3=9q23=DDH
z3=Fc|3=9{z7#Q|(F)+;HVqloc#lR58#lYae#lRrT#lXP8#lUcblY!w7Cj-MOP6mb<
zoD2-pIT;u_IT;x8IT;unI2jo1IT;uXIT;w(IT;wfa4;|&<X~WE;$UD%<X~X%<6vO;
z!_L5PmYsnio}Hnd!IPbV;WrxtLpK`(gESih!v|Idh5}XwhB#IRhC3__3{fl$43R7h
z3??iL42PH*7|NL$7&4g|7<8B!7~U{3Fsx!?V5nzeU@&H4U{GXYVEDkuz_5oA;!R5?
p28P>=3=G|j3=AnCZ!<6`pn}PHP6C^kId0;b{KZjcbA-<dV*r>fFwy`3

delta 291
zcmZo@U}|V!+7KYX=)E~mV6#52Jp%(nJ0k-Fg8&1A_hdnb==z`B3=C_y85p{_85lgd
z85sU>F)+O1VqiGN#lUcoi-Dnui-94Bi-EzDi-AFhi-CcKi-F-CCj-MZP6mb}oD2+y
zIT;wXaxyT?=44>V;bdUQ=44=q<z!$m=44<{;ACKU%fY~~j)Q@rmxF<!ii3ecgM)$L
zCp!Z}H#-AEDLX?pgE~6{!*(_X26r|F1{pR6hB>SZ3|*`Y3>>Ts3~ek746Q5-3<)d@
z4DXm37#1@#Fid4;V2EI5V31&DV7SJ_z_6N$fgzrWfx(xFfkB3ef#C%s#ES(?3=Eb`
m3=Fp!85p`585mL+CmZA_PX1UWF{zqkbGG9_uFVlXD~tgoIx)@w

diff --git a/python/examples/cart_pulling.py b/python/examples/cart_pulling.py
index aaf3bac..86dca38 100644
--- a/python/examples/cart_pulling.py
+++ b/python/examples/cart_pulling.py
@@ -128,6 +128,7 @@ def cartPullingControlLoop(args, robot : RobotManager, goal, solver_grasp, solve
     if robot.robot_name != "yumi":
         graspOK, grasp_pose = isGripperRelativeToBaseOK(args, robot)
     else:
+        goal_transform = pin.SE3.Identity()
         graspOK, grasp_pose = areDualGrippersRelativeToBaseOK(args, goal_transform, robot)
     # NOTE: this keeps getting reset after initial grasp has been completed.
     # and we want to let mpc cook
-- 
GitLab