Merge pull request #1 from mlosch/master

First revision of vision stuff
Merge pull request #2 from mlosch/master

Working M1 vision
Merge remote-tracking branch 'upstream/master'
make sure we do not put out rois when there is no ground visible
remove debug output
add alternative downsampling method based on random point choosing. To be tested on real data