PF commit

Convergence criteria - inside a 5cm square around the center of mass
for 5 iterations in a row