imported from commit bd76729bcbfd64b5d016a9b936f058931fc06eaf. Only minor changes to make it compile. Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>