Yeah this should be in the code base. But again, this is just an operation on vectors matrices, you you can just use eigen3 here. No need to have a method. Later, this will be coded against shoguns linear algebra interface