Designing the Concurrent Searching and Pathfinding Algorithm for Swarm Robotics