[cpp][test] Implemente computeCom and eigenVector3dToMaal function & cosmetic change

Guilhem Saurel requested to merge TheophaneL:dev into dev