Solver working again and solving problems.
Patched numerical issue with norms and division. This will need more attention later.