Do not repeat the checking loop in the read and write
functions. Use a single helper function for that check and
call it in both accessors.
Signed-off-by: NJoerg Roedel <joro@8bytes.org>