heinous kalman filter bug
tidies; more or less works now