Fix camera pose output from keyboard control tool (#137)

Author: yuecideng

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}")