Removed matrices for debugging, norm(g) is now above 1 for most, this is wrong