Print links in collision

[Abishalini]

Description

The CheckStartStateCollision adapter does return failure when links are in collision but it currently does not say which links are in collision. This PR adds the links in collision to the MoveItErrorCode message so it can help with debugging.

[codecov]

Codecov Report

Attention: Patch coverage is 0% with 6 lines in your changes are missing coverage. Please review.

Project coverage is 42.98%. Comparing base (d962501) to head (0ffe748).
Report is 17 commits behind head on main.

Files	Patch %	Lines
...dapter_plugins/src/check_start_state_collision.cpp	0.00%	6 Missing ⚠️

Additional details and impacted files

@@            Coverage Diff             @@
##             main    #2727      +/-   ##
==========================================
- Coverage   50.74%   42.98%   -7.76%     
==========================================
  Files         392      692     +300     
  Lines       32553    56333   +23780     
  Branches        0     7273    +7273     
==========================================
+ Hits        16517    24210    +7693     
- Misses      16036    31962   +15926     
- Partials        0      161     +161     

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

[sjahr]

This will be helpful for debugging, thanks!