Stereo Vision - Some fixes