I think the KF is working with dummy sensor data :D  Wow.  Thats cool.  Need to get the sensor model working now.