CFO_TH_XTAL_LOW
if (abs(cfo_average) < CFO_TH_XTAL_LOW)
if (cfo_average > CFO_TH_XTAL_LOW)
else if (cfo_average < -CFO_TH_XTAL_LOW)
if (CFO_ave < CFO_TH_XTAL_LOW && CFO_ave > (-CFO_TH_XTAL_LOW))
if (CFO_ave > CFO_TH_XTAL_LOW)
Adjust_Xtal = Adjust_Xtal + ((CFO_ave - CFO_TH_XTAL_LOW) >> 2);
else if (CFO_ave < (-CFO_TH_XTAL_LOW))
Adjust_Xtal = Adjust_Xtal + ((CFO_TH_XTAL_LOW - CFO_ave) >> 2);
if (CFO_ave > CFO_TH_XTAL_LOW)
else if (CFO_ave < (-CFO_TH_XTAL_LOW))