modify programs for 2 robots
Merge pull request #23 from irvs/issue21

modify programs for 2 robots