Added initialization steps which attempt to measure the initial observation noise variances.  These variances are then used to initialize the Kalman filter.  Still need to add a communications output to the autopilot.  It would also be nice to use the LEDs on the board for something.  Blinky lights are good, I want them.