Very simple flocking like controller working
heterogeneous