A system and method for determining location of a tool having a distal end sensor and at least one other sensor is presented. The method includes obtaining data from the distal end sensor, performing convergence on the obtained data, the convergence indicating whether or not the obtained data is disturbed, when the convergence indicates the obtained data is not disturbed, calculate the location of the tool using the obtained data, and when the convergence indicates the obtained data is disturbed, obtaining additional data from the at least one other sensor, performing the convergence on the obtained additional data, and calculating the location of the tool using the obtained additional data.
