Reverted code to read registers

The write_then_readinto() function does not appear to reliably read the registers. Reverted code back to use an explicit write() followed by a readinto().