On a motion capture task, sensors outputs in CSV format are to be analyzed. We need a basic algorithm which provides comparison for different measurements.
Different markers and rigid bodies (max 2) exists. Their spatial position and angle information is needed. Also their comparison with respect to each other must be provided.