Added freq change double-check, some AFC code, and CPS output in debug
mode.