gaoxiang12 / slambook2

edition 2 of the slambook
MIT License
5.3k stars 1.99k forks source link

Wrong Rodrigues’ formula #301

Open MichaelRazum opened 4 months ago

MichaelRazum commented 4 months ago

Hi there,

not 100% sure but it seems that equation (3.15) R = cos θI + (1 − cos θ) nnT + sin θn∧ should be without the cos θ term R = I + (1 − cos θ) nnT + sin θn∧

At least based on the derivation in wikipedia. https://en.wikipedia.org/wiki/Rodrigues%27_rotation_formula