fixed saving debug images
drawing road points with proper old pose
RR - lower min points limit
RR - filtering road width
RR - using proper reference altitude for video frame