A new Camera Model and Algorithms for higher Accuracy and better Convergence in Vision-based Pose Calculations