Map Basic search implemented
Added contribution to queue length