Add classes and functions to test odometry based on trihedrons
Merge branch 'master' of https://github.com/jesusbriales/corner-calib