While at it move register modification to static inlines and
so make the relevant code more readable.
Signed-off-by: NUwe Kleine-König <u.kleine-koenig@pengutronix.de>