Jan De Geeter, Hendrik Van Brussel, Joris De Schutter: A Smoothly Constrained Kalman Filter. IEEE Trans. Pattern Anal. Mach. Intell. 19(10): 1171-1177 (1997)