modify mainCentroid.py fix all problems, add test_centroid.py