Update
This commit is contained in:
parent
304c89c7ed
commit
bfb565fd18
@ -166,10 +166,10 @@ def spawn_brick(vertical=True):
|
|||||||
brick_pose.position.x = 0.485
|
brick_pose.position.x = 0.485
|
||||||
brick_pose.position.y = 0.709
|
brick_pose.position.y = 0.709
|
||||||
brick_pose.position.z = 0.818
|
brick_pose.position.z = 0.818
|
||||||
brick_pose.orientation.x = 0.5
|
brick_pose.orientation.x = 0
|
||||||
brick_pose.orientation.y = 0.5
|
brick_pose.orientation.y = 0.707
|
||||||
brick_pose.orientation.z = -0.5
|
brick_pose.orientation.z = 0
|
||||||
brick_pose.orientation.w = 0.5
|
brick_pose.orientation.w = 0.707
|
||||||
else:
|
else:
|
||||||
brick_pose.position.x = 0.4664
|
brick_pose.position.x = 0.4664
|
||||||
brick_pose.position.y = 0.8069
|
brick_pose.position.y = 0.8069
|
||||||
|
|||||||
@ -24,7 +24,7 @@ def etq(roll, pitch, yaw):
|
|||||||
def q_extrapolator(obj):
|
def q_extrapolator(obj):
|
||||||
return obj.orientation.x, obj.orientation.y, obj.orientation.z, obj.orientation.w
|
return obj.orientation.x, obj.orientation.y, obj.orientation.z, obj.orientation.w
|
||||||
|
|
||||||
print(etq(1.570733, 1.570733, 0))
|
print(etq(1.570733, 1.570733, 1.570733))
|
||||||
|
|
||||||
exit(0)
|
exit(0)
|
||||||
|
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user