Working program. Testet against the exact solution and is consistent.