AHRS Firmware for the SparkFun 9DOF Razor IMU and SparkFun 9DOF Sensor Stick