fix(freespace_planning_algorithms): set goal z to path

[kosuke55]

Signed-off-by: kosuke55 kosuke.tnp@gmail.com

Description

set goal z to path

before

after

Related links

Tests performed

psim

Notes for reviewers

Pre-review checklist for the PR author

The PR author must check the checkboxes below when creating the PR.

• I've confirmed the contribution guidelines.
• The PR follows the pull request guidelines.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

• The PR follows the pull request guidelines.
• The PR has been properly tested.
• The PR has been reviewed by the code owners.

Post-review checklist for the PR author

The PR author must check the checkboxes below before merging.

• There are no open discussions or they are tracked via tickets.
• The PR is ready for merge.

After all checkboxes are checked, anyone who has write access can merge the PR.

[takayuki5168]

LGTM

[codecov]

Codecov Report

Base: 11.63% // Head: 11.69% // Increases project coverage by +0.06% 🎉

Coverage data is based on head (5bf912c) compared to base (d6c0c09).
Patch coverage: 100.00% of modified lines in pull request are covered.

Additional details and impacted files

@@            Coverage Diff             @@
##             main    #2797      +/-   ##
==========================================
+ Coverage   11.63%   11.69%   +0.06%     
==========================================
  Files        1317     1317              
  Lines       91839    91912      +73     
  Branches    24382    24421      +39     
==========================================
+ Hits        10681    10751      +70     
+ Misses      70007    70006       -1     
- Partials    11151    11155       +4     

Flag	Coverage Δ		*Carryforward flag
differential	61.59% <100.00%> (?)
total	11.63% <100.00%> (ø)		Carriedforward from d6c0c09

*This pull request uses carry forward flags. Click here to find out more.

Impacted Files	Coverage Δ
...ude/freespace_planning_algorithms/astar_search.hpp	88.88% <ø> (+1.38%)	⬆️
...freespace_planning_algorithms/src/astar_search.cpp	78.76% <100.00%> (+7.79%)	⬆️
...ning/freespace_planning_algorithms/src/rrtstar.cpp	65.38% <100.00%> (ø)

Help us with your feedback. Take ten seconds to tell us how you rate us. Have a feature suggestion? Share it here.

☔ View full report at Codecov.
📢 Do you have feedback about the report comment? Let us know in this issue.