KF with DirectNavigator
This MR will fix a problem in the current DirectNavigator: the surface iterator will NOT be updated if the track is intersected with the surface but NOT within boundary. It also adapt the KF to use the DirectNavigator.
The MR is splitted from !652 (closed) .