Introduce 16-bit register write function to simplify the code in
some places.
Signed-off-by: Guenter Roeck <linux@roeck-us.net>