Revision history [back]

I managed to find an answer to this problem myself. The cause of this problem was that the field_of_view attribute of the range messages coming from the sonars was sent in degrees instead of in radians, as is expected by the range sensor layer. Although this still visualizes the sonar cone in rviz, this probably messes up the coding in the internals of the range sensor layer.

Sending the field_of_view attribute in radians instead of degrees immediately solved this issue, and now the sonars are integrated into the costmap as expected.