Develop stages 1 and 2 of projustor code

This commit allows for the sensor to gather data and find the optimal
distance for the object.