Backport mesh construction error to debug msg (#531)

[iche033]

🦟 Bug fix

Backport of #531

Checklist

• Signed all commits for DCO
• Added tests
• Updated documentation (as needed)
• Updated migration guide (as needed)
• Consider updating Python bindings (if the library has them)
• codecheck passed (See contributing)
• All tests passed (See test coverage)
• While waiting for a review on your PR, please help review another open pull request to support the maintainers

Note to maintainers: Remember to use Squash-Merge and edit the commit message to match the pull request summary while retaining Signed-off-by messages.

[codecov]

Codecov Report

Attention: 2 lines in your changes are missing coverage. Please review.

Comparison is base (5b74d1f) 78.59% compared to head (fad4342) 78.59%.

Files	Patch %	Lines
dartsim/src/SDFFeatures.cc	0.00%	2 Missing ⚠️

Additional details and impacted files

@@             Coverage Diff              @@
##           gz-physics6     #581   +/-   ##
============================================
  Coverage        78.59%   78.59%           
============================================
  Files              140      140           
  Lines             7654     7654           
============================================
  Hits              6016     6016           
  Misses            1638     1638           

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