Fixed (?) error in swing hip torque calculation, but this seems to make it worse