Add register test program
Add support for reading/writing registers