Use center of mass and fix criteria in Benchmark.m