p_obstacles done

FinalProject/Check_Point_5/check_point5.py

@@ -95,7 +95,6 @@ if result != vrep.simx_return_ok:
 result, dummy_position = vrep.simxGetObjectPosition(clientID, dummy_handle, -1, vrep.simx_opmode_oneshot_wait)
 if result != vrep.simx_return_ok:
     raise Exception('Could not get object position for Dummy')
-print(dummy_position)
 entry_one.append(dummy_position[0])
 entry_two.append(dummy_position[1])
 entry_three.append(dummy_position[2])
@@ -111,17 +110,17 @@ for i in range(11):
     result, dummy_position = vrep.simxGetObjectPosition(clientID, dummy_handle, -1, vrep.simx_opmode_blocking)
     if result != vrep.simx_return_ok:
         raise Exception('Could not get object position for ', dummy_name)
-    print (dummy_position)
     entry_one.append(dummy_position[0])
     entry_two.append(dummy_position[1])
     entry_three.append(dummy_position[2])
 entry_one = np.asarray(entry_one)
 entry_two = np.asarray(entry_two)
 entry_three = np.asarray(entry_three)
+
 p_obstacle = np.block([
 [np.asarray(entry_one)], [np.asarray(entry_two)], [np.asarray(entry_three)]
 ])
-print ("p_obstacle: ", p_obstacle)
+
 
 ################## Place removal at the end of the simulation ##################
 # Remove dummy handles for ConcretBlock1