empirically determine error standard deviation for pose estimation

[gcschmit]

Instead of using the default standard deviation as we do for drivetrain-based pose estimation updates or our equation for vision-based pose estimation updates, we should make a series of measurements and calculate the actual standard deviation. This needs to be done for both drivetrain and vision since if either is incorrect, it will invalidate the other.