Following logic improved a bit
Core module updated to not follow a person who is farther away from the goal than the robot