Scan message filter added and velocity parametrized