From 6658237490e4b9ef656cf1de878b7ca9c82fa3a4 Mon Sep 17 00:00:00 2001
From: Max Hunt <mh2817@ic.ac.uk>
Date: Sat, 8 Feb 2020 17:47:13 +0000
Subject: [PATCH] Update

---
 main.py | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/main.py b/main.py
index 040443c..5ef8aee 100755
--- a/main.py
+++ b/main.py
@@ -390,4 +390,10 @@ right_pose.orientation.y = 0.999649402929
 right_pose.orientation.z = -0.00737916180073
 right_pose.orientation.w = 0.00486450832011
 
+left_pnp = PickAndPlace('left', hover_distance)
+right_pnp = PickAndPlace('right', hover_distance)
+
+# Go to initial position
+left_pnp.move_to_start(left_pnp.ik_request(left_pose))
+right_pnp.move_to_start(right_pnp.ik_request(right_pose))