Fix write_CSR()
Fix for first_index in read_CSR()