Changes made to have both robots in the simulation. The test1 world has
been added, but need to add a world file for test2. The grid does not
always show up and I haven't gotten the visualizer class set up yet.