Merge pull request #23 from irvs/issue21

modify programs for 2 robots
modify thread's timing