search

joansola / slamtb

SLAM Toolbox
GNU General Public License v3.0
260 stars 121 forks source link

Check R2e #3

Open MedericFourmy opened 5 years ago

MedericFourmy commented 5 years ago

change pitch by this

e(1) = atan2(-_R(2,0), sqrt(_R(0,0)*_R(0,0) + _R(1,0)*_R(1,0)));

indices are 012 not 123