[test] test procedure for forces added, repulsion forces updated, formation control is good except the agents which are at the boundary