Use correct subframe for external orientations interpolation

The interpolation process in the external orientations sets the starting orientation from a subframe from the previous frame. The subframe is fetched from the same position as the current subframe index. Instead, the most recent subframe should be used.

Also the frozen orientations are not working as intended, as the values might incorrectly read from previous frame.