Add some sanity checks to the calculations and make the REG_16 register write consistent
with the other ones.
Signed-off-by: NMichael Buesch <m@bues.ch>
Signed-off-by: NMauro Carvalho Chehab <mchehab@redhat.com>