Skip to content

Commit

Permalink
Set OXTS poses to be in imu_link frame
Browse files Browse the repository at this point in the history
Base link is now a child of imu_link.
Quick fix. May be better to transform the poses so that base_link rests on z=0 plane.
  • Loading branch information
Celyn Walters authored and Celyn Walters committed Oct 19, 2018
1 parent 06100b0 commit df5c844
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions bin/kitti2bag
Original file line number Diff line number Diff line change
Expand Up @@ -53,7 +53,7 @@ def save_dynamic_tf(bag, kitti, kitti_type, initial_time):
tf_oxts_transform = TransformStamped()
tf_oxts_transform.header.stamp = rospy.Time.from_sec(float(timestamp.strftime("%s.%f")))
tf_oxts_transform.header.frame_id = 'world'
tf_oxts_transform.child_frame_id = 'base_link'
tf_oxts_transform.child_frame_id = 'imu_link'

transform = (oxts.T_w_imu)
t = transform[0:3, 3]
Expand Down Expand Up @@ -322,7 +322,7 @@ def main():

# tf_static
transforms = [
('base_link', imu_frame_id, T_base_link_to_imu),
(imu_frame_id, 'base_link', T_base_link_to_imu),
(imu_frame_id, velo_frame_id, inv(kitti.calib.T_velo_imu)),
(imu_frame_id, cameras[0][1], inv(kitti.calib.T_cam0_imu)),
(imu_frame_id, cameras[1][1], inv(kitti.calib.T_cam1_imu)),
Expand Down

0 comments on commit df5c844

Please sign in to comment.