History

I think I've already done most of the infrastructure for multiple robots, but it has only been tested with one. Also, you should check that I am checking error codes and such, since I kind of rushed to finish by the meeting today. You may want to refactor a bit as well.