Original work by Magnus Damm, tested and tweaked by Simon Horman
Signed-off-by: NMagnus Damm <damm@opensource.se>
Signed-off-by: NSimon Horman <horms@verge.net.au>
Signed-off-by: NRafael J. Wysocki <rjw@sisk.pl>