saveOsimInverseDynamicsRawForcesXMLFile assigned incorrect body to force plate

[THEONE-1]

This function failed to find the correct body-plate correspondence over the attached data. report_error.zip

I'm not sure what the "forcePlates.corners" is. If it's CoP, then the bug might be in this loop, where distance is computed regardless of swing/stance phase. Swing phase should be excluded as CoP has no meaning.