Issue575 freq - part one.

Next part of support for frequency in SATC, including the algorithm update to match Iain advice/feedback.