A method includes receiving a worksite plan to be executed by a machine at a worksite, and determining first travel parameters of the machine. Such first travel parameters include a first travel path along a work surface, and first work tool positions. The method also includes controlling the machine to traverse at least part of the first travel path, receiving sensor information associated with the work surface, and identifying an imperfection of the work surface located along the first travel path. The method further includes determining second travel parameters of the machine. Such second travel parameters including a second travel path along the work surface, and second work tool positions. The method also includes controlling the machine to traverse at least part of the second travel path while positioning the work tool according to at least one of the second work tool positions.