Fixes bosch-ros-pkg/bosch_drivers#36.
Merge pull request #38 from proan/sub20

Fixes bosch-ros-pkg/bosch_drivers#36.