Image Processing Algorithm for Integrated Sense And Avoid Systems