METHOD AND SYSTEM FOR ADAPTIVE MAP SURVEY ROUTE PLANNING

A method for determining a route for a map surveyed includes receiving an initial survey plan and commanding the vehicle to move to survey a terrain by following the initial survey plan. Further, the method includes surveying the terrain with the plurality of sensors and determining a confidence level of each of the plurality of map areas surveyed with the plurality of sensors of the vehicle. Moreover, the method includes predicting a confidence level of each of the plurality of map areas yet to be surveyed according to the initial survey plan. The method also includes determining a confidence penalty based on the confidence data and determining whether the confidence penalty is greater than a predetermined threshold. Further, the method includes adapting the initial survey plan to produce an updated survey plan.