diff --git a/new_main.py b/new_main.py index 914c084..d5533c1 100644 --- a/new_main.py +++ b/new_main.py @@ -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.y = 0.707 - brick_pose.orientation.z = 0 - brick_pose.orientation.w = 0.707 + brick_pose.orientation.x = 0.5 + brick_pose.orientation.y = 0.5 + brick_pose.orientation.z = -0.5 + brick_pose.orientation.w = 0.5 brick_reference_frame = 'world' brick_id = brick_ids.pop() spawn_sdf(brick_id, brick_sdf, "/", brick_pose, brick_reference_frame) diff --git a/redundant/brick_data.py b/redundant/brick_data.py index a54a9af..fe696ce 100644 --- a/redundant/brick_data.py +++ b/redundant/brick_data.py @@ -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(0, 1.570733, 0)) +print(etq(1.570733, 1.570733, 0)) exit(0)