Graph search

It is useful to implement a graph search between KF, providing the vector and the approximated covariance between two KF.