Updating error logging in Smac collision detector object

[codecov[bot]]

Codecov Report

All modified and coverable lines are covered by tests :white_check_mark:

Files with missing lines	Coverage Δ
nav2_smac_planner/src/collision_checker.cpp	100.00% <100.00%> (+3.12%)	:arrow_up:

... and 1 file with indirect coverage changes