Improve ForceAngleCompliance in case of plane change.

[DmytroMuravskyi]

BACKGROUND:

• While working with the function I have found that although it produces correct angles, it does unnecessary deviations sometimes.

DESCRIPTION:

• If there are two segments that need to be aligned but previous segment is perpendicular to both of them, it's better to use triangle that include those two segment instead, since perpendicular segment will have correct angle with any configuration of that triangle.

TESTING:

• Added new test PolylineForceAngleCompliancePathChangesPlane that shows a case new changes does better.

FUTURE WORK:

REQUIRED:

• [x] All changes are up to date in CHANGELOG.md.

COMMENTS:

• I also included new cast fixes in Grid2d that were in my repo for a while. They don't break any build but help avoid unnecessary up casts.

---

This change is 

[DmytroMuravskyi]

Refinement is required