Depthfunction works now
Merge branch 'develop' of github.com:tistatos/TNM061-StereoSnowSim into develop