Finished simulation for three robots.
Problem: not do two iteration