Finished the non maxima suppression function.
Finished the FCG-T2 work.