diff options
Diffstat (limited to 'drivers/nvmem/regmap.c')
-rw-r--r-- | drivers/nvmem/regmap.c | 40 |
1 files changed, 27 insertions, 13 deletions
diff --git a/drivers/nvmem/regmap.c b/drivers/nvmem/regmap.c index 641e6413ba..24712fbb0f 100644 --- a/drivers/nvmem/regmap.c +++ b/drivers/nvmem/regmap.c @@ -1,4 +1,4 @@ -// SPDX-License-Identifier: GPL-2.0 +// SPDX-License-Identifier: GPL-2.0-only #include <common.h> #include <driver.h> #include <malloc.h> @@ -6,12 +6,22 @@ #include <errno.h> #include <init.h> #include <io.h> -#include <regmap.h> +#include <linux/regmap.h> #include <linux/nvmem-provider.h> static int nvmem_regmap_write(void *ctx, unsigned offset, const void *val, size_t bytes) { - return regmap_bulk_write(ctx, offset, val, bytes); + struct regmap *map = ctx; + + /* + * eFuse writes going through this function may be irreversible, + * so expect users to observe alignment. + */ + if (bytes % regmap_get_val_bytes(map)) + return -EINVAL; + + return regmap_bulk_write(map, offset, val, + bytes / regmap_get_val_bytes(map)); } static int nvmem_regmap_read(void *ctx, unsigned offset, void *buf, size_t bytes) @@ -28,11 +38,11 @@ static int nvmem_regmap_read(void *ctx, unsigned offset, void *buf, size_t bytes skip_bytes = offset & (stride - 1); rbytes = roundup(bytes + skip_bytes, stride); - if (roffset + rbytes > stride * regmap_get_max_register(map)) + if (roffset + rbytes > regmap_size_bytes(map)) return -EINVAL; for (i = roffset; i < roffset + rbytes; i += stride) { - ret = regmap_bulk_read(map, i, &val, stride); + ret = regmap_read(map, i, &val); if (ret) { dev_err(regmap_get_device(map), "Can't read data%d (%d)\n", i, ret); return ret; @@ -53,12 +63,9 @@ static int nvmem_regmap_read(void *ctx, unsigned offset, void *buf, size_t bytes return 0; } -static struct nvmem_bus nvmem_regmap_bus = { - .read = nvmem_regmap_read, - .write = nvmem_regmap_write, -}; - -struct nvmem_device *nvmem_regmap_register(struct regmap *map, const char *name) +struct nvmem_device * +nvmem_regmap_register_with_pp(struct regmap *map, const char *name, + nvmem_cell_post_process_t cell_post_process) { struct nvmem_config config = {}; @@ -71,8 +78,15 @@ struct nvmem_device *nvmem_regmap_register(struct regmap *map, const char *name) config.priv = map; config.stride = 1; config.word_size = 1; - config.size = regmap_get_max_register(map) * regmap_get_reg_stride(map); - config.bus = &nvmem_regmap_bus; + config.size = regmap_size_bytes(map); + config.cell_post_process = cell_post_process; + config.reg_write = nvmem_regmap_write; + config.reg_read = nvmem_regmap_read; return nvmem_register(&config); } + +struct nvmem_device *nvmem_regmap_register(struct regmap *map, const char *name) +{ + return nvmem_regmap_register_with_pp(map, name, NULL); +} |