Code migrated from http://cmssw.cvs.cern.ch/cgi-bin/cmssw.cgi/UserCode/RutgersSandbox/RutgersSubJetAlgorithm/