3D point tracking using stereo camera with color thresholding and disparity