Added methods for global optimization in Trihedron

Added global optimization based on orthogonality and 3D Plane Distance residues
Methods for plotting cost function and computing hessian have been included too.

Added calls in main_Jesus
Added methods for global optimization in Trihedron (bis)