Should be similar to https://github.com/SharedAutonomyToolkit/shared_autonomy_perception/blob/launch-files/clear_table/src/clear_table/sensor_handler.py.
