added disparity SAD function - needs work