Skip to content
Snippets Groups Projects
Commit a1ae16a6 authored by r0650n's avatar r0650n
Browse files

p_obstacles done

parent 06dfbe06
No related branches found
No related tags found
No related merge requests found
No preview for this file type
No preview for this file type
No preview for this file type
......@@ -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
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment