[add] weird working kalman (WIP)