Implementation of an Extended Kalman Filter for optical motion capture with real – time 3 D visualization