This commit is contained in:
Max Hunt 2020-02-15 01:28:10 +00:00
parent 858989cf5d
commit 9651db5c63
2 changed files with 5 additions and 5 deletions

View File

@ -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 brick_pose.orientation.x = -0.5
brick_pose.orientation.y = 0.707 brick_pose.orientation.y = 0.5
brick_pose.orientation.z = 0 brick_pose.orientation.z = 0.5
brick_pose.orientation.w = 0.707 brick_pose.orientation.w = 0.5
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

View File

@ -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, 1.570733)) print(etq(1.570733, 1.570733, 3.14))
exit(0) exit(0)