Made some changes to serial config to remove potential bugs.

Re-wrote acc/gyro calibration and removed rounding errors from lib_fp_lowpassfilter to increase imi accuracy.