Some debugging - also works better if the identity matrix is not fucked up...