fixed the H matrix. Now everything works!!!!