Extended features: Copes with missing markers indicated by 0 and/or NaN in trc-file. Takes into account joint limits as soft constraints. Marker error report. Two options: with and without visualizer. Visualizer shows the intermediate Kalman filter result and the final Kalman smoother result.