I had promised to send this a while ago, please have a look
at this cleanup I did to move code out of mach-ux500 into the
respective drivers.
Clearly this is not for 4.7 at this time, but if it works, it
would be nice to get it merged into 4.8.
Arnd