Merge pull request #8 from iirob/indigo_dev

Correction of velocity collision filter