tum-vision / lsd_slam

LSD-SLAM
GNU General Public License v3.0
2.59k stars 1.23k forks source link

How to use LSD Slam to project world points #162

Open v0n0 opened 8 years ago

v0n0 commented 8 years ago

If I want to display a cube depending on the current pose, can I use scaledCamToWorld() directly? It does not seem to give me the right projection. I do:

cornerCam = camToWorldRinv * cubeCorner + camToWorldTinv
cornerIm = cornerCam.xy / cornerCam.z * focalLength + principalPoint

With little rotation it seems that just the scale is a little off. With 45deg rotation it seems it is rotating of 90deg. In general it doesn't seem to stick to a specific position in the 3D world, while if I print the depth maps from tracking on the live image they are perfectly following edges. Why is that? Do I need to multiply the pose by the scale? Any clue @JakobEngel?

v0n0 commented 8 years ago

Anybody?