dexter2406
dexter2406
/ trajectory_utils.py
Created
August 19, 2020 12:50
— forked from wmuron/trajectory_utils.py
SfMLearner - merging consecutive poses sequences into single trajectory
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| import numpy as np | |
| from kitti_eval.pose_evaluation_utils import pose_vec_to_mat | |
| def convert_and_change_coordinate_system(poses, new_coord_index=0): | |
| coord_pose = pose_vec_to_mat(poses[new_coord_index]) | |
| out = [] | |
| for pose_vec in poses: | |
| pose = pose_vec_to_mat(pose_vec) |