finished pointsFromDisparity; added -1 offset to px & py in main