Add files for robot_self_filter

Taken from 7f8364d038e572a6027b8504fcddcdc2ae0c6dd2
Tested with https://github.com/tu-darmstadt-ros-pkg/robot_self_filter on hydro