Merge pull request #126 from ipa-fxm/velocity_interface_controller_indigo

[Indigo] Velocity interface controller indigo