diff --git a/brick/model.sdf b/brick/model.sdf
index fac3885..61bcc6e 100755
--- a/brick/model.sdf
+++ b/brick/model.sdf
@@ -7,10 +7,10 @@
0 0 0.0 -0 0
0.1
- 0.00002
+ 0.000002
0
0
- 0.00002
+ 0.000002
0
0
@@ -25,8 +25,8 @@
- 100000
- 10000
+ 1000000
+ 100000
0 0 1
0.7
0.7
@@ -34,8 +34,8 @@
- 10000.000000
- 10000.00000
+ 100000.000000
+ 1000000.00000
20.000000
0.0001
diff --git a/new_main.py b/new_main.py
index 6ccaece..985c21a 100644
--- a/new_main.py
+++ b/new_main.py
@@ -146,6 +146,20 @@ class PickAndPlace(object):
# retract to clear object
self._retract()
+ def cust_place(self, pose):
+ # servo above pose
+ approach = copy.deepcopy(pose)
+ # approach with a pose the hover-distance above the requested pose
+ approach.position.z = approach.position.z + 0.1
+ joint_angles = self.ik_request(approach)
+ self._guarded_move_to_joint_position(joint_angles)
+ # servo to pose
+ self._servo_to_pose(pose)
+ # open the gripper
+ self.gripper_open()
+ # retract to clear object
+ self._retract()
+
brick_ids = ['b1','b2','b3','b4','b5','b6','b7','b8','b9']
@@ -251,4 +265,4 @@ left_pnp.place(brickstuff[9]['pose'])
paused = raw_input('Continue?')
spawn_v_brick()
left_pnp.pick(brickstuff[0]['pose'])
-left_pnp.place(brickstuff[10]['pose'])
+left_pnp.cust_place(brickstuff[10]['pose'])