initial check-in of SVfit algorithm (CMSSW plugin version)