Kwak, Zhang and Vasconcelos algorithms with a new main function to compare the results.
Optim
Merge branch 'Trihedron' of https://github.com/jesusbriales/corner-calib into zhang

Merge of Trihedron into Zhang
Minor changes
Merge branch 'zhang'

Merge branch zhang