New Version

combine track to track fusion and track to system fusion together, and
SVF fusion algorithm and CI fusion algorithm together