[Backport of #2222]: Skip joints not belonging to RobotModel

[mfruhner]

Add check to skip joints not in RobotModel

Description

I backported the changes of #2222 to humble. This prevents printing error messages when the robot_model contains more joints than just the robot arm.

Checklist

• Required by CI: Code is auto formatted using clang-format
• Extend the tutorials / documentation reference
• Document API changes relevant to the user in the MIGRATION.md notes
• Create tests, which fail without this PR reference
• Include a screenshot if changing a GUI
• While waiting for someone to review your request, please help review another open pull request to support the maintainers

[mergify]

Please target the main branch for development, we will backport the changes to humble for you if approved and if they don't break API.

[EzraBrooks]

very odd that mergify refuses to backport the original PR to humble..

[EzraBrooks]

I've seen this in the wild too. Thanks for backporting!

[EzraBrooks]

oop, spoke too soon - needs a pre-commit format

[codecov]

Codecov Report

❌ Patch coverage is 50.00000% with 1 line in your changes missing coverage. Please review.
✅ Project coverage is 51.21%. Comparing base (ac933b6) to head (fe00f83).
⚠️ Report is 3 commits behind head on humble.

Files with missing lines	Patch %	Lines
...anning_scene_monitor/src/current_state_monitor.cpp	50.00%	1 Missing ⚠️

Additional details and impacted files

@@            Coverage Diff             @@
##           humble    #3634      +/-   ##
==========================================
+ Coverage   51.20%   51.21%   +0.01%     
==========================================
  Files         407      407              
  Lines       30665    30667       +2     
==========================================
+ Hits        15700    15704       +4     
+ Misses      14965    14963       -2     

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

🚀 New features to boost your workflow:

• ❄️ Test Analytics: Detect flaky tests, report on failures, and find test suite problems.

[mfruhner]

oop, spoke too soon - needs a pre-commit format

sorry for that. Should be fixed now.