feat: camera move forward along y axis of the world frame

tomas789 · Mar 29, 2021 · db628a4 · db628a4
1 parent 00fbefe
commit db628a4
Show file tree

Hide file tree

Showing 2 changed files with 4 additions and 3 deletions.
diff --git a/README.md b/README.md
@@ -33,7 +33,7 @@ Thanks to the work of @jnitsch, _kitti2bag_ can now export velodyne laser data a
 ## How to install it?
 
 It is very easy! On the machine with ROS installed, just run
-install pykitti from source
+install pykitti from <span style="text-decoration: underline">source</span> instead of from pip
 ```bash
 git clone https://github.com/utiasSTARS/pykitti.git # test on commit d3e1bb81676e831886726cc5ed79ce1f049aef2c
 cd pykitti

diff --git a/kitti2bag/kitti2bag.py b/kitti2bag/kitti2bag.py
@@ -390,10 +390,11 @@ def run_kitti2bag():
         try:
             velo_frame_id = 'velo_link'
             velo_topic = '/kitti/velo'
+            tf_camera_init = np.array([[1, 0, 0, 0],[0, 0, 1, 0],[0, -1, 0, 0],[0, 0, 0, 1]])
 
             transforms = [
-                ('world', 'velo_init', np.eye(4, 4)),
-                ('world', 'camera_init', inv(kitti.calib.T_cam0_velo)),
+                ('world', 'camera_init', tf_camera_init),
+                ('world', 'velo_init', tf_camera_init.dot(kitti.calib.T_cam0_velo)),
                 (cameras[0][1], velo_frame_id, kitti.calib.T_cam0_velo),
                 (cameras[0][1], cameras[1][1], kitti.calib.T_cam0_velo.dot(inv(kitti.calib.T_cam1_velo))),
                 (cameras[0][1], cameras[2][1], kitti.calib.T_cam0_velo.dot(inv(kitti.calib.T_cam2_velo))),