b43: Rewrite LO calibration algorithm