dh/dx now matches
beginning tests on EKF. look reasonable so far