Skip to content

Commit

Permalink
Fix python pipeline (#131)
Browse files Browse the repository at this point in the history
  • Loading branch information
nachovizzo committed Apr 6, 2023
1 parent 393a951 commit 65b3ea9
Showing 1 changed file with 1 addition and 1 deletion.
2 changes: 1 addition & 1 deletion python/kiss_icp/pipeline.py
Original file line number Diff line number Diff line change
Expand Up @@ -125,7 +125,7 @@ def _to_tum_format(poses, timestamps):
for idx in range(len(poses)):
tx, ty, tz = poses[idx][:3, -1].flatten()
qw, qx, qy, qz = Quaternion(matrix=poses[idx], atol=0.01).elements
tum_data.append([timestamps[idx], tx, ty, tz, qx, qy, qz, qw])
tum_data.append([float(timestamps[idx]), tx, ty, tz, qx, qy, qz, qw])
return np.array(tum_data).astype(np.float64)

np.savetxt(fname=f"{filename}_tum.txt", X=_to_tum_format(poses, timestamps), fmt="%.4f")
Expand Down

0 comments on commit 65b3ea9

Please sign in to comment.