CI fusion algorithm

implementation of CI fusion algorithm for 'track to system' system