Add general trihedron computation functions
Fix verbose in Manifold/Dyn
Newton method implemented with Manifolds option
Modifications in main for trihedron computation