bugfix in align_sim3()
Merge branch 'master' of https://github.com/uzh-rpg/rpg_vikit into dev
refactoring