added IDL kalman filter test code, these are so cool