Made some changes to the serial config code.

Re-wrote the acc/gyro calibration and fixed rounding errors in lib_fp_lowpassfilter for better imu accuracy.