Fix bug in getClosestJointSolution in simple planner utils

[Levi-Armstrong]

No description provided.

[codecov]

Codecov Report

Merging #146 (a8aa69f) into master (e4afe13) will decrease coverage by 0.02%.
The diff coverage is 100.00%.

@@            Coverage Diff             @@
##           master     #146      +/-   ##
==========================================
- Coverage   67.53%   67.50%   -0.03%     
==========================================
  Files         196      196              
  Lines        9241     9242       +1     
==========================================
- Hits         6241     6239       -2     
- Misses       3000     3003       +3     

Impacted Files	Coverage Δ
...s/core/src/simple/profile/simple_planner_utils.cpp	79.76% <100.00%> (+0.11%)	⬆️
..._planners/ompl/src/continuous_motion_validator.cpp	93.44% <0.00%> (-4.92%)	⬇️