Updated comments in robots, added Baxter, did some minor tuning
Updated URDF loading to be more robust