trying to implement stereo 3D reconstruction with matlab