Let INDEX==1 be a test for velocity controller