Use parabollic trajectory for pelvis angle offset