|
@@ -1119,6 +1119,8 @@ static void *nvmem_cell_prepare_write_buffer(struct nvmem_cell *cell,
|
|
|
|
|
|
/* setup the first byte with lsb bits from nvmem */
|
|
|
rc = nvmem_reg_read(nvmem, cell->offset, &v, 1);
|
|
|
+ if (rc)
|
|
|
+ goto err;
|
|
|
*b++ |= GENMASK(bit_offset - 1, 0) & v;
|
|
|
|
|
|
/* setup rest of the byte if any */
|
|
@@ -1137,11 +1139,16 @@ static void *nvmem_cell_prepare_write_buffer(struct nvmem_cell *cell,
|
|
|
/* setup the last byte with msb bits from nvmem */
|
|
|
rc = nvmem_reg_read(nvmem,
|
|
|
cell->offset + cell->bytes - 1, &v, 1);
|
|
|
+ if (rc)
|
|
|
+ goto err;
|
|
|
*p |= GENMASK(7, (nbits + bit_offset) % BITS_PER_BYTE) & v;
|
|
|
|
|
|
}
|
|
|
|
|
|
return buf;
|
|
|
+err:
|
|
|
+ kfree(buf);
|
|
|
+ return ERR_PTR(rc);
|
|
|
}
|
|
|
|
|
|
/**
|