Updated Search to work with 1 robot. Tested the full main in simulation. All system working.