Renamed to clarify right/left foot acc vectors
Couple of changes to read pelvis position when initializing state
(to be more generic when osim file changes)