Fix memory growth issue in isPoseOccupied

[mini-1235]

---

Basic Info

Info	Please fill out this column
Ticket(s) this addresses	Fixes #5690
Primary OS tested on	(Ubuntu, MacOS, Windows)
Robotic platform tested on	(Steve's Robot, gazebo simulation of Tally, hardware turtlebot)
Does this PR contain AI generated software?	(No; Yes and it is marked inline in the code)
Was this PR description generated by AI software?	Out of respect for maintainers, AI for human-to-human communications are banned

---

Description of contribution in a few bullet points

Description of documentation updates required from your changes

Description of how this change was tested

---

Future work that may be required in bullet points

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
• Should this be backported to current distributions? If so, tag with backport-*.

[SteveMacenski]

Once @chanhhoang99 approves, happy to merge

[codecov]

Codecov Report

✅ All modified and coverable lines are covered by tests.

Files with missing lines	Coverage Δ
...e/plugins/condition/is_pose_occupied_condition.hpp	100.00% <100.00%> (ø)
...tree/plugins/condition/is_path_valid_condition.cpp	100.00% <100.00%> (ø)
...e/plugins/condition/is_pose_occupied_condition.cpp	100.00% <100.00%> (ø)

... and 15 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]

@chanhhoang99 does this solve the issue from your testing?

[chanhhoang99]

@SteveMacenski , I applied changes and tested for several hours yesterday. Memory is stable, no CPU usage increase.

[SteveMacenski]

Great! @mini-1235 can you change this from a draft?