Refactors thomas algorithm out of the finite differences method
Makes tests use ConstIterator instead of a big constant vector