added debugging signals to test magnetometer.  updated heading calculation method.  succesfully including fixed point math library now.