Skip to content

Commit

Permalink
formatting
Browse files Browse the repository at this point in the history
  • Loading branch information
glvov-bdai committed Sep 6, 2024
1 parent 0a9af0a commit 490c330
Showing 1 changed file with 5 additions and 2 deletions.
7 changes: 5 additions & 2 deletions spot_wrapper/calibration/calibration_util.py
Original file line number Diff line number Diff line change
Expand Up @@ -766,7 +766,7 @@ def est_camera_t_charuco_board_center(
rmat, _ = cv2.Rodrigues(rvec)

tvec = tvec + rmat.dot(center_trans)
#tvec_to_camera = -rmat.T @ tvec
# tvec_to_camera = -rmat.T @ tvec
tvec_to_camera = tvec
return np.array(rmat), np.array(tvec_to_camera).ravel()
else:
Expand All @@ -776,7 +776,9 @@ def est_camera_t_charuco_board_center(
"Couldn't detect any Charuco boards in the image, "
"localization failed. Ensure the board is visible from the"
" primed pose."
)
)


# def est_camera_t_charuco_board_center(
# img: np.ndarray,
# charuco_board: cv2.aruco_CharucoBoard,
Expand Down Expand Up @@ -838,6 +840,7 @@ def est_camera_t_charuco_board_center(
# " primed pose."
# )


def convert_camera_t_viewpoint_to_origin_t_planning_frame(
origin_t_planning_frame: np.ndarray = np.eye(4),
planning_frame_t_opencv_camera: np.ndarray = np.eye(4),
Expand Down

0 comments on commit 490c330

Please sign in to comment.