Bad Herustic Func. Going to use center of mass in the next commit