Documented Code, added an uncert field to robot location, changed uncert estimates