Working version of FireFinder. Add Action in PathPlanner.