Change to goal checker orientation for yaw angle

[RasmusLar]

Basic Info

Info	Please fill out this column
Ticket(s) this addresses	N/A
Primary OS tested on	Ubuntu
Robotic platform tested on	GTest
Does this PR contain AI generated software?	Yes (GH Copilot)

---

Description of contribution in a few bullet points

• While writing unit tests for Remove unnecessary sqrt calculations #4942, fixed discrepancy in goal checker orientation, which was checking for < tolerance instead of <= tolerance, as all the other limit checks are.
• Reduced tolerance time for the progress checker unit tests to 0.1 seconds, to reduce test runtime from ~17 to ~7 seconds.
• Added edge case unit tests

Description of documentation updates required from your changes

• I think no documentation update is needed.

Description of how this change was tested

• Only unit tests

---

Future work that may be required in bullet points

• Other performance improvements that I can see, reduced copying values from const references

For Maintainers:

• Check that any new parameters added are updated in docs.nav2.org
• Check that any significant change is added to the migration guide
• Check that any new features OR changes to existing behaviors are reflected in the tuning guide
• Check that any new functions have Doxygen added
• Check that any new features have test coverage
• Check that any new plugins is added to the plugins page
• If BT Node, Additionally: add to BT's XML index of nodes for groot, BT package's readme table, and BT library lists

[codecov]

Codecov Report

All modified and coverable lines are covered by tests ✅

Files with missing lines	Coverage Δ
nav2_controller/plugins/simple_goal_checker.cpp	100.00% <100.00%> (ø)

... and 7 files with indirect coverage changes

🚀 New features to boost your workflow:

• ❄ Test Analytics: Detect flaky tests, report on failures, and find test suite problems.

[SteveMacenski]

Thanks!