Fix read register issue

• Make read-register and write-register return an a status, to check if it was actually successful
• For write-register explicitly read back register after write to check if the correct value was written
• Also clean up some of the names of functions in the code to be more intuitive

Addresses #221 (closed)