mba6x_bl: Read back register writes

To make sure the reg writes stick we read them back and compare
the values.

Signed-off-by: Patrik Jakobsson <patrik.r.jakobsson@gmail.com>