Update svd to use orthogonalisation
Add add method