Added kalman_demo. This is an attitude/position EKF example.