Bug fixes to GaussJacobi. Add a test.