diff --git a/embodichain/lab/sim/utility/keyboard_utils.py b/embodichain/lab/sim/utility/keyboard_utils.py index f5997c03..27dde849 100644 --- a/embodichain/lab/sim/utility/keyboard_utils.py +++ b/embodichain/lab/sim/utility/keyboard_utils.py @@ -196,8 +196,11 @@ def run_keyboard_control_for_camera( pose_changed = True log_info("Reset to initial pose") elif key == ord("p"): - translation = new_pose[:3, 3] - rot = R.from_matrix(new_pose[:3, :3]) + new_pose_print = new_pose.copy() + new_pose_print[:3, 1] = -new_pose_print[:3, 1] + new_pose_print[:3, 2] = -new_pose_print[:3, 2] + translation = new_pose_print[:3, 3] + rot = R.from_matrix(new_pose_print[:3, :3]) quaternion = rot.as_quat() log_info("Current Camera pose:") log_info(f"Translation: {translation}")