Skip to content

Instantly share code, notes, and snippets.

@dexter2406
dexter2406 / trajectory_utils.py
Created Aug 19, 2020 — forked from wmuron/trajectory_utils.py
SfMLearner - merging consecutive poses sequences into single trajectory
View trajectory_utils.py
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)