This commit is contained in:
Max Hunt 2020-02-15 01:34:45 +00:00
parent 7733415c2c
commit 728d718e02
2 changed files with 3 additions and 3 deletions

View File

@ -165,10 +165,10 @@ def spawn_v_brick():
brick_pose.position.x = 0.485
brick_pose.position.y = 0.709
brick_pose.position.z = 0.818
brick_pose.orientation.x = 0
brick_pose.orientation.x = 0.707
brick_pose.orientation.y = 0
brick_pose.orientation.z = 0
brick_pose.orientation.w = 0
brick_pose.orientation.w = 0.707
brick_reference_frame = 'world'
brick_id = brick_ids.pop()
spawn_sdf(brick_id, brick_sdf, "/", brick_pose, brick_reference_frame)

View File

@ -24,7 +24,7 @@ def etq(roll, pitch, yaw):
def q_extrapolator(obj):
return obj.orientation.x, obj.orientation.y, obj.orientation.z, obj.orientation.w
print(etq(3.14, 1.570733, 3.14))
print(etq(1.570733, 0, 0))
exit(0)