This is essentially the code that was factored out into the core when the
feature was implemented.
Signed-off-by: NMark Brown <broonie@opensource.wolfsonmicro.com>