Merge pull request #1 from ipa-fxm/enable_joint_filtering

Enable joint filtering
Merge pull request #3 from ipa-fmw/indigo_new_structure

Merge pull request #1 from ipa-fxm/enable_joint_filtering