Kalman filter function

@danielaaroe do you have any inf. about how i chose the dt valu to make suitable readings . do you use it in balncing robots. thanks