heuristic added to avoid distanecs from initial posture