add test_centroid.py and modify findCentroid.py