Move nearest intersection code from TrajectoryHandler

[rtoole13]

This code likely needs to be elsewhere, as, ideally, this would update semi-realtime when dragging around maneuver nodes.