fix(goal_planner): use precise distance to objects for sorting candidate paths #2950

Job	Run time
require-label / require-label	3s
check-if-cuda-job-is-needed	20s
build-and-test-differential / build-and-test-differential	19m 58s
build-and-test-packages-above-differential / build-and-test-packages-above-differential	20m 1s
build-and-test-differential-cuda / build-and-test-differential	0s
clang-tidy-differential-cuda / clang-tidy-differential	-1s
clang-tidy-differential / clang-tidy-differential	0s
	40m 21s

Provide feedback