Fix the problem that the robot does not move when it reaches the nest in the initialization. The robot will not have the chance to swith to search before it reaches the nest in the initialization. After it reaches the nest, it will do the random search and have the chance to switch to search
Fix the problem that the robot does not move when it reaches the nest in the initialization. The robot will not have the chance to swith to search before it reaches the nest in the initialization. After it reaches the nest, it will do the random search and have the chance to switch to search

BCLab-UNM/CPFA-ARGoS,BCLab-UNM/CPFA-ARGoS,BCLab-UNM/CPFA-ARGoS