1 // SPDX-License-Identifier: GPL-2.0
3 * nvmem framework core.
5 * Copyright (C) 2015 Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
6 * Copyright (C) 2013 Maxime Ripard <maxime.ripard@free-electrons.com>
9 #include <linux/device.h>
10 #include <linux/export.h>
12 #include <linux/idr.h>
13 #include <linux/init.h>
14 #include <linux/kref.h>
15 #include <linux/module.h>
16 #include <linux/nvmem-consumer.h>
17 #include <linux/nvmem-provider.h>
18 #include <linux/gpio/consumer.h>
20 #include <linux/slab.h>
34 struct bin_attribute eeprom;
35 struct device *base_dev;
36 struct list_head cells;
37 const struct nvmem_keepout *keepout;
38 unsigned int nkeepout;
39 nvmem_reg_read_t reg_read;
40 nvmem_reg_write_t reg_write;
41 struct gpio_desc *wp_gpio;
42 struct nvmem_layout *layout;
46 #define to_nvmem_device(d) container_of(d, struct nvmem_device, dev)
48 #define FLAG_COMPAT BIT(0)
49 struct nvmem_cell_entry {
56 nvmem_cell_post_process_t read_post_process;
58 struct device_node *np;
59 struct nvmem_device *nvmem;
60 struct list_head node;
64 struct nvmem_cell_entry *entry;
69 static DEFINE_MUTEX(nvmem_mutex);
70 static DEFINE_IDA(nvmem_ida);
72 static DEFINE_MUTEX(nvmem_cell_mutex);
73 static LIST_HEAD(nvmem_cell_tables);
75 static DEFINE_MUTEX(nvmem_lookup_mutex);
76 static LIST_HEAD(nvmem_lookup_list);
78 static BLOCKING_NOTIFIER_HEAD(nvmem_notifier);
80 static DEFINE_SPINLOCK(nvmem_layout_lock);
81 static LIST_HEAD(nvmem_layouts);
83 static int __nvmem_reg_read(struct nvmem_device *nvmem, unsigned int offset,
84 void *val, size_t bytes)
87 return nvmem->reg_read(nvmem->priv, offset, val, bytes);
92 static int __nvmem_reg_write(struct nvmem_device *nvmem, unsigned int offset,
93 void *val, size_t bytes)
97 if (nvmem->reg_write) {
98 gpiod_set_value_cansleep(nvmem->wp_gpio, 0);
99 ret = nvmem->reg_write(nvmem->priv, offset, val, bytes);
100 gpiod_set_value_cansleep(nvmem->wp_gpio, 1);
107 static int nvmem_access_with_keepouts(struct nvmem_device *nvmem,
108 unsigned int offset, void *val,
109 size_t bytes, int write)
112 unsigned int end = offset + bytes;
113 unsigned int kend, ksize;
114 const struct nvmem_keepout *keepout = nvmem->keepout;
115 const struct nvmem_keepout *keepoutend = keepout + nvmem->nkeepout;
119 * Skip all keepouts before the range being accessed.
120 * Keepouts are sorted.
122 while ((keepout < keepoutend) && (keepout->end <= offset))
125 while ((offset < end) && (keepout < keepoutend)) {
126 /* Access the valid portion before the keepout. */
127 if (offset < keepout->start) {
128 kend = min(end, keepout->start);
129 ksize = kend - offset;
131 rc = __nvmem_reg_write(nvmem, offset, val, ksize);
133 rc = __nvmem_reg_read(nvmem, offset, val, ksize);
143 * Now we're aligned to the start of this keepout zone. Go
146 kend = min(end, keepout->end);
147 ksize = kend - offset;
149 memset(val, keepout->value, ksize);
157 * If we ran out of keepouts but there's still stuff to do, send it
161 ksize = end - offset;
163 return __nvmem_reg_write(nvmem, offset, val, ksize);
165 return __nvmem_reg_read(nvmem, offset, val, ksize);
171 static int nvmem_reg_read(struct nvmem_device *nvmem, unsigned int offset,
172 void *val, size_t bytes)
174 if (!nvmem->nkeepout)
175 return __nvmem_reg_read(nvmem, offset, val, bytes);
177 return nvmem_access_with_keepouts(nvmem, offset, val, bytes, false);
180 static int nvmem_reg_write(struct nvmem_device *nvmem, unsigned int offset,
181 void *val, size_t bytes)
183 if (!nvmem->nkeepout)
184 return __nvmem_reg_write(nvmem, offset, val, bytes);
186 return nvmem_access_with_keepouts(nvmem, offset, val, bytes, true);
189 #ifdef CONFIG_NVMEM_SYSFS
190 static const char * const nvmem_type_str[] = {
191 [NVMEM_TYPE_UNKNOWN] = "Unknown",
192 [NVMEM_TYPE_EEPROM] = "EEPROM",
193 [NVMEM_TYPE_OTP] = "OTP",
194 [NVMEM_TYPE_BATTERY_BACKED] = "Battery backed",
195 [NVMEM_TYPE_FRAM] = "FRAM",
198 #ifdef CONFIG_DEBUG_LOCK_ALLOC
199 static struct lock_class_key eeprom_lock_key;
202 static ssize_t type_show(struct device *dev,
203 struct device_attribute *attr, char *buf)
205 struct nvmem_device *nvmem = to_nvmem_device(dev);
207 return sprintf(buf, "%s\n", nvmem_type_str[nvmem->type]);
210 static DEVICE_ATTR_RO(type);
212 static struct attribute *nvmem_attrs[] = {
217 static ssize_t bin_attr_nvmem_read(struct file *filp, struct kobject *kobj,
218 struct bin_attribute *attr, char *buf,
219 loff_t pos, size_t count)
222 struct nvmem_device *nvmem;
228 dev = kobj_to_dev(kobj);
229 nvmem = to_nvmem_device(dev);
231 /* Stop the user from reading */
232 if (pos >= nvmem->size)
235 if (!IS_ALIGNED(pos, nvmem->stride))
238 if (count < nvmem->word_size)
241 if (pos + count > nvmem->size)
242 count = nvmem->size - pos;
244 count = round_down(count, nvmem->word_size);
246 if (!nvmem->reg_read)
249 rc = nvmem_reg_read(nvmem, pos, buf, count);
257 static ssize_t bin_attr_nvmem_write(struct file *filp, struct kobject *kobj,
258 struct bin_attribute *attr, char *buf,
259 loff_t pos, size_t count)
262 struct nvmem_device *nvmem;
268 dev = kobj_to_dev(kobj);
269 nvmem = to_nvmem_device(dev);
271 /* Stop the user from writing */
272 if (pos >= nvmem->size)
275 if (!IS_ALIGNED(pos, nvmem->stride))
278 if (count < nvmem->word_size)
281 if (pos + count > nvmem->size)
282 count = nvmem->size - pos;
284 count = round_down(count, nvmem->word_size);
286 if (!nvmem->reg_write)
289 rc = nvmem_reg_write(nvmem, pos, buf, count);
297 static umode_t nvmem_bin_attr_get_umode(struct nvmem_device *nvmem)
301 if (!nvmem->root_only)
304 if (!nvmem->read_only)
307 if (!nvmem->reg_write)
310 if (!nvmem->reg_read)
316 static umode_t nvmem_bin_attr_is_visible(struct kobject *kobj,
317 struct bin_attribute *attr, int i)
319 struct device *dev = kobj_to_dev(kobj);
320 struct nvmem_device *nvmem = to_nvmem_device(dev);
322 attr->size = nvmem->size;
324 return nvmem_bin_attr_get_umode(nvmem);
327 /* default read/write permissions */
328 static struct bin_attribute bin_attr_rw_nvmem = {
333 .read = bin_attr_nvmem_read,
334 .write = bin_attr_nvmem_write,
337 static struct bin_attribute *nvmem_bin_attributes[] = {
342 static const struct attribute_group nvmem_bin_group = {
343 .bin_attrs = nvmem_bin_attributes,
344 .attrs = nvmem_attrs,
345 .is_bin_visible = nvmem_bin_attr_is_visible,
348 static const struct attribute_group *nvmem_dev_groups[] = {
353 static struct bin_attribute bin_attr_nvmem_eeprom_compat = {
357 .read = bin_attr_nvmem_read,
358 .write = bin_attr_nvmem_write,
362 * nvmem_setup_compat() - Create an additional binary entry in
363 * drivers sys directory, to be backwards compatible with the older
364 * drivers/misc/eeprom drivers.
366 static int nvmem_sysfs_setup_compat(struct nvmem_device *nvmem,
367 const struct nvmem_config *config)
374 if (!config->base_dev)
377 if (config->type == NVMEM_TYPE_FRAM)
378 bin_attr_nvmem_eeprom_compat.attr.name = "fram";
380 nvmem->eeprom = bin_attr_nvmem_eeprom_compat;
381 nvmem->eeprom.attr.mode = nvmem_bin_attr_get_umode(nvmem);
382 nvmem->eeprom.size = nvmem->size;
383 #ifdef CONFIG_DEBUG_LOCK_ALLOC
384 nvmem->eeprom.attr.key = &eeprom_lock_key;
386 nvmem->eeprom.private = &nvmem->dev;
387 nvmem->base_dev = config->base_dev;
389 rval = device_create_bin_file(nvmem->base_dev, &nvmem->eeprom);
392 "Failed to create eeprom binary file %d\n", rval);
396 nvmem->flags |= FLAG_COMPAT;
401 static void nvmem_sysfs_remove_compat(struct nvmem_device *nvmem,
402 const struct nvmem_config *config)
405 device_remove_bin_file(nvmem->base_dev, &nvmem->eeprom);
408 #else /* CONFIG_NVMEM_SYSFS */
410 static int nvmem_sysfs_setup_compat(struct nvmem_device *nvmem,
411 const struct nvmem_config *config)
415 static void nvmem_sysfs_remove_compat(struct nvmem_device *nvmem,
416 const struct nvmem_config *config)
420 #endif /* CONFIG_NVMEM_SYSFS */
422 static void nvmem_release(struct device *dev)
424 struct nvmem_device *nvmem = to_nvmem_device(dev);
426 ida_free(&nvmem_ida, nvmem->id);
427 gpiod_put(nvmem->wp_gpio);
431 static const struct device_type nvmem_provider_type = {
432 .release = nvmem_release,
435 static struct bus_type nvmem_bus_type = {
439 static void nvmem_cell_entry_drop(struct nvmem_cell_entry *cell)
441 blocking_notifier_call_chain(&nvmem_notifier, NVMEM_CELL_REMOVE, cell);
442 mutex_lock(&nvmem_mutex);
443 list_del(&cell->node);
444 mutex_unlock(&nvmem_mutex);
445 of_node_put(cell->np);
446 kfree_const(cell->name);
450 static void nvmem_device_remove_all_cells(const struct nvmem_device *nvmem)
452 struct nvmem_cell_entry *cell, *p;
454 list_for_each_entry_safe(cell, p, &nvmem->cells, node)
455 nvmem_cell_entry_drop(cell);
458 static void nvmem_cell_entry_add(struct nvmem_cell_entry *cell)
460 mutex_lock(&nvmem_mutex);
461 list_add_tail(&cell->node, &cell->nvmem->cells);
462 mutex_unlock(&nvmem_mutex);
463 blocking_notifier_call_chain(&nvmem_notifier, NVMEM_CELL_ADD, cell);
466 static int nvmem_cell_info_to_nvmem_cell_entry_nodup(struct nvmem_device *nvmem,
467 const struct nvmem_cell_info *info,
468 struct nvmem_cell_entry *cell)
471 cell->offset = info->offset;
472 cell->raw_len = info->raw_len ?: info->bytes;
473 cell->bytes = info->bytes;
474 cell->name = info->name;
475 cell->read_post_process = info->read_post_process;
476 cell->priv = info->priv;
478 cell->bit_offset = info->bit_offset;
479 cell->nbits = info->nbits;
483 cell->bytes = DIV_ROUND_UP(cell->nbits + cell->bit_offset,
486 if (!IS_ALIGNED(cell->offset, nvmem->stride)) {
488 "cell %s unaligned to nvmem stride %d\n",
489 cell->name ?: "<unknown>", nvmem->stride);
496 static int nvmem_cell_info_to_nvmem_cell_entry(struct nvmem_device *nvmem,
497 const struct nvmem_cell_info *info,
498 struct nvmem_cell_entry *cell)
502 err = nvmem_cell_info_to_nvmem_cell_entry_nodup(nvmem, info, cell);
506 cell->name = kstrdup_const(info->name, GFP_KERNEL);
514 * nvmem_add_one_cell() - Add one cell information to an nvmem device
516 * @nvmem: nvmem device to add cells to.
517 * @info: nvmem cell info to add to the device
519 * Return: 0 or negative error code on failure.
521 int nvmem_add_one_cell(struct nvmem_device *nvmem,
522 const struct nvmem_cell_info *info)
524 struct nvmem_cell_entry *cell;
527 cell = kzalloc(sizeof(*cell), GFP_KERNEL);
531 rval = nvmem_cell_info_to_nvmem_cell_entry(nvmem, info, cell);
537 nvmem_cell_entry_add(cell);
541 EXPORT_SYMBOL_GPL(nvmem_add_one_cell);
544 * nvmem_add_cells() - Add cell information to an nvmem device
546 * @nvmem: nvmem device to add cells to.
547 * @info: nvmem cell info to add to the device
548 * @ncells: number of cells in info
550 * Return: 0 or negative error code on failure.
552 static int nvmem_add_cells(struct nvmem_device *nvmem,
553 const struct nvmem_cell_info *info,
558 for (i = 0; i < ncells; i++) {
559 rval = nvmem_add_one_cell(nvmem, &info[i]);
568 * nvmem_register_notifier() - Register a notifier block for nvmem events.
570 * @nb: notifier block to be called on nvmem events.
572 * Return: 0 on success, negative error number on failure.
574 int nvmem_register_notifier(struct notifier_block *nb)
576 return blocking_notifier_chain_register(&nvmem_notifier, nb);
578 EXPORT_SYMBOL_GPL(nvmem_register_notifier);
581 * nvmem_unregister_notifier() - Unregister a notifier block for nvmem events.
583 * @nb: notifier block to be unregistered.
585 * Return: 0 on success, negative error number on failure.
587 int nvmem_unregister_notifier(struct notifier_block *nb)
589 return blocking_notifier_chain_unregister(&nvmem_notifier, nb);
591 EXPORT_SYMBOL_GPL(nvmem_unregister_notifier);
593 static int nvmem_add_cells_from_table(struct nvmem_device *nvmem)
595 const struct nvmem_cell_info *info;
596 struct nvmem_cell_table *table;
597 struct nvmem_cell_entry *cell;
600 mutex_lock(&nvmem_cell_mutex);
601 list_for_each_entry(table, &nvmem_cell_tables, node) {
602 if (strcmp(nvmem_dev_name(nvmem), table->nvmem_name) == 0) {
603 for (i = 0; i < table->ncells; i++) {
604 info = &table->cells[i];
606 cell = kzalloc(sizeof(*cell), GFP_KERNEL);
612 rval = nvmem_cell_info_to_nvmem_cell_entry(nvmem, info, cell);
618 nvmem_cell_entry_add(cell);
624 mutex_unlock(&nvmem_cell_mutex);
628 static struct nvmem_cell_entry *
629 nvmem_find_cell_entry_by_name(struct nvmem_device *nvmem, const char *cell_id)
631 struct nvmem_cell_entry *iter, *cell = NULL;
633 mutex_lock(&nvmem_mutex);
634 list_for_each_entry(iter, &nvmem->cells, node) {
635 if (strcmp(cell_id, iter->name) == 0) {
640 mutex_unlock(&nvmem_mutex);
645 static int nvmem_validate_keepouts(struct nvmem_device *nvmem)
647 unsigned int cur = 0;
648 const struct nvmem_keepout *keepout = nvmem->keepout;
649 const struct nvmem_keepout *keepoutend = keepout + nvmem->nkeepout;
651 while (keepout < keepoutend) {
652 /* Ensure keepouts are sorted and don't overlap. */
653 if (keepout->start < cur) {
655 "Keepout regions aren't sorted or overlap.\n");
660 if (keepout->end < keepout->start) {
662 "Invalid keepout region.\n");
668 * Validate keepouts (and holes between) don't violate
669 * word_size constraints.
671 if ((keepout->end - keepout->start < nvmem->word_size) ||
672 ((keepout->start != cur) &&
673 (keepout->start - cur < nvmem->word_size))) {
676 "Keepout regions violate word_size constraints.\n");
681 /* Validate keepouts don't violate stride (alignment). */
682 if (!IS_ALIGNED(keepout->start, nvmem->stride) ||
683 !IS_ALIGNED(keepout->end, nvmem->stride)) {
686 "Keepout regions violate stride.\n");
698 static int nvmem_add_cells_from_dt(struct nvmem_device *nvmem, struct device_node *np)
700 struct nvmem_layout *layout = nvmem->layout;
701 struct device *dev = &nvmem->dev;
702 struct device_node *child;
706 for_each_child_of_node(np, child) {
707 struct nvmem_cell_info info = {0};
709 addr = of_get_property(child, "reg", &len);
712 if (len < 2 * sizeof(u32)) {
713 dev_err(dev, "nvmem: invalid reg on %pOF\n", child);
718 info.offset = be32_to_cpup(addr++);
719 info.bytes = be32_to_cpup(addr);
720 info.name = kasprintf(GFP_KERNEL, "%pOFn", child);
722 addr = of_get_property(child, "bits", &len);
723 if (addr && len == (2 * sizeof(u32))) {
724 info.bit_offset = be32_to_cpup(addr++);
725 info.nbits = be32_to_cpup(addr);
728 info.np = of_node_get(child);
730 if (layout && layout->fixup_cell_info)
731 layout->fixup_cell_info(nvmem, layout, &info);
733 ret = nvmem_add_one_cell(nvmem, &info);
744 static int nvmem_add_cells_from_legacy_of(struct nvmem_device *nvmem)
746 return nvmem_add_cells_from_dt(nvmem, nvmem->dev.of_node);
749 static int nvmem_add_cells_from_fixed_layout(struct nvmem_device *nvmem)
751 struct device_node *layout_np;
754 layout_np = of_nvmem_layout_get_container(nvmem);
758 if (of_device_is_compatible(layout_np, "fixed-layout"))
759 err = nvmem_add_cells_from_dt(nvmem, layout_np);
761 of_node_put(layout_np);
766 int __nvmem_layout_register(struct nvmem_layout *layout, struct module *owner)
768 layout->owner = owner;
770 spin_lock(&nvmem_layout_lock);
771 list_add(&layout->node, &nvmem_layouts);
772 spin_unlock(&nvmem_layout_lock);
776 EXPORT_SYMBOL_GPL(__nvmem_layout_register);
778 void nvmem_layout_unregister(struct nvmem_layout *layout)
780 spin_lock(&nvmem_layout_lock);
781 list_del(&layout->node);
782 spin_unlock(&nvmem_layout_lock);
784 EXPORT_SYMBOL_GPL(nvmem_layout_unregister);
786 static struct nvmem_layout *nvmem_layout_get(struct nvmem_device *nvmem)
788 struct device_node *layout_np, *np = nvmem->dev.of_node;
789 struct nvmem_layout *l, *layout = ERR_PTR(-EPROBE_DEFER);
791 layout_np = of_get_child_by_name(np, "nvmem-layout");
796 * In case the nvmem device was built-in while the layout was built as a
797 * module, we shall manually request the layout driver loading otherwise
798 * we'll never have any match.
800 of_request_module(layout_np);
802 spin_lock(&nvmem_layout_lock);
804 list_for_each_entry(l, &nvmem_layouts, node) {
805 if (of_match_node(l->of_match_table, layout_np)) {
806 if (try_module_get(l->owner))
813 spin_unlock(&nvmem_layout_lock);
814 of_node_put(layout_np);
819 static void nvmem_layout_put(struct nvmem_layout *layout)
822 module_put(layout->owner);
825 static int nvmem_add_cells_from_layout(struct nvmem_device *nvmem)
827 struct nvmem_layout *layout = nvmem->layout;
830 if (layout && layout->add_cells) {
831 ret = layout->add_cells(&nvmem->dev, nvmem, layout);
839 #if IS_ENABLED(CONFIG_OF)
841 * of_nvmem_layout_get_container() - Get OF node to layout container.
843 * @nvmem: nvmem device.
845 * Return: a node pointer with refcount incremented or NULL if no
846 * container exists. Use of_node_put() on it when done.
848 struct device_node *of_nvmem_layout_get_container(struct nvmem_device *nvmem)
850 return of_get_child_by_name(nvmem->dev.of_node, "nvmem-layout");
852 EXPORT_SYMBOL_GPL(of_nvmem_layout_get_container);
855 const void *nvmem_layout_get_match_data(struct nvmem_device *nvmem,
856 struct nvmem_layout *layout)
858 struct device_node __maybe_unused *layout_np;
859 const struct of_device_id *match;
861 layout_np = of_nvmem_layout_get_container(nvmem);
862 match = of_match_node(layout->of_match_table, layout_np);
864 return match ? match->data : NULL;
866 EXPORT_SYMBOL_GPL(nvmem_layout_get_match_data);
869 * nvmem_register() - Register a nvmem device for given nvmem_config.
870 * Also creates a binary entry in /sys/bus/nvmem/devices/dev-name/nvmem
872 * @config: nvmem device configuration with which nvmem device is created.
874 * Return: Will be an ERR_PTR() on error or a valid pointer to nvmem_device
878 struct nvmem_device *nvmem_register(const struct nvmem_config *config)
880 struct nvmem_device *nvmem;
884 return ERR_PTR(-EINVAL);
886 if (!config->reg_read && !config->reg_write)
887 return ERR_PTR(-EINVAL);
889 nvmem = kzalloc(sizeof(*nvmem), GFP_KERNEL);
891 return ERR_PTR(-ENOMEM);
893 rval = ida_alloc(&nvmem_ida, GFP_KERNEL);
896 return ERR_PTR(rval);
901 nvmem->dev.type = &nvmem_provider_type;
902 nvmem->dev.bus = &nvmem_bus_type;
903 nvmem->dev.parent = config->dev;
905 device_initialize(&nvmem->dev);
907 if (!config->ignore_wp)
908 nvmem->wp_gpio = gpiod_get_optional(config->dev, "wp",
910 if (IS_ERR(nvmem->wp_gpio)) {
911 rval = PTR_ERR(nvmem->wp_gpio);
912 nvmem->wp_gpio = NULL;
916 kref_init(&nvmem->refcnt);
917 INIT_LIST_HEAD(&nvmem->cells);
919 nvmem->owner = config->owner;
920 if (!nvmem->owner && config->dev->driver)
921 nvmem->owner = config->dev->driver->owner;
922 nvmem->stride = config->stride ?: 1;
923 nvmem->word_size = config->word_size ?: 1;
924 nvmem->size = config->size;
925 nvmem->root_only = config->root_only;
926 nvmem->priv = config->priv;
927 nvmem->type = config->type;
928 nvmem->reg_read = config->reg_read;
929 nvmem->reg_write = config->reg_write;
930 nvmem->keepout = config->keepout;
931 nvmem->nkeepout = config->nkeepout;
933 nvmem->dev.of_node = config->of_node;
934 else if (!config->no_of_node)
935 nvmem->dev.of_node = config->dev->of_node;
937 switch (config->id) {
938 case NVMEM_DEVID_NONE:
939 rval = dev_set_name(&nvmem->dev, "%s", config->name);
941 case NVMEM_DEVID_AUTO:
942 rval = dev_set_name(&nvmem->dev, "%s%d", config->name, nvmem->id);
945 rval = dev_set_name(&nvmem->dev, "%s%d",
946 config->name ? : "nvmem",
947 config->name ? config->id : nvmem->id);
954 nvmem->read_only = device_property_present(config->dev, "read-only") ||
955 config->read_only || !nvmem->reg_write;
957 #ifdef CONFIG_NVMEM_SYSFS
958 nvmem->dev.groups = nvmem_dev_groups;
961 if (nvmem->nkeepout) {
962 rval = nvmem_validate_keepouts(nvmem);
967 if (config->compat) {
968 rval = nvmem_sysfs_setup_compat(nvmem, config);
974 * If the driver supplied a layout by config->layout, the module
975 * pointer will be NULL and nvmem_layout_put() will be a noop.
977 nvmem->layout = config->layout ?: nvmem_layout_get(nvmem);
978 if (IS_ERR(nvmem->layout)) {
979 rval = PTR_ERR(nvmem->layout);
980 nvmem->layout = NULL;
982 if (rval == -EPROBE_DEFER)
983 goto err_teardown_compat;
987 rval = nvmem_add_cells(nvmem, config->cells, config->ncells);
989 goto err_remove_cells;
992 rval = nvmem_add_cells_from_table(nvmem);
994 goto err_remove_cells;
996 rval = nvmem_add_cells_from_legacy_of(nvmem);
998 goto err_remove_cells;
1000 dev_dbg(&nvmem->dev, "Registering nvmem device %s\n", config->name);
1002 rval = device_add(&nvmem->dev);
1004 goto err_remove_cells;
1006 rval = nvmem_add_cells_from_fixed_layout(nvmem);
1008 goto err_remove_cells;
1010 rval = nvmem_add_cells_from_layout(nvmem);
1012 goto err_remove_cells;
1014 blocking_notifier_call_chain(&nvmem_notifier, NVMEM_ADD, nvmem);
1019 nvmem_device_remove_all_cells(nvmem);
1020 nvmem_layout_put(nvmem->layout);
1021 err_teardown_compat:
1023 nvmem_sysfs_remove_compat(nvmem, config);
1025 put_device(&nvmem->dev);
1027 return ERR_PTR(rval);
1029 EXPORT_SYMBOL_GPL(nvmem_register);
1031 static void nvmem_device_release(struct kref *kref)
1033 struct nvmem_device *nvmem;
1035 nvmem = container_of(kref, struct nvmem_device, refcnt);
1037 blocking_notifier_call_chain(&nvmem_notifier, NVMEM_REMOVE, nvmem);
1039 if (nvmem->flags & FLAG_COMPAT)
1040 device_remove_bin_file(nvmem->base_dev, &nvmem->eeprom);
1042 nvmem_device_remove_all_cells(nvmem);
1043 nvmem_layout_put(nvmem->layout);
1044 device_unregister(&nvmem->dev);
1048 * nvmem_unregister() - Unregister previously registered nvmem device
1050 * @nvmem: Pointer to previously registered nvmem device.
1052 void nvmem_unregister(struct nvmem_device *nvmem)
1055 kref_put(&nvmem->refcnt, nvmem_device_release);
1057 EXPORT_SYMBOL_GPL(nvmem_unregister);
1059 static void devm_nvmem_unregister(void *nvmem)
1061 nvmem_unregister(nvmem);
1065 * devm_nvmem_register() - Register a managed nvmem device for given
1067 * Also creates a binary entry in /sys/bus/nvmem/devices/dev-name/nvmem
1069 * @dev: Device that uses the nvmem device.
1070 * @config: nvmem device configuration with which nvmem device is created.
1072 * Return: Will be an ERR_PTR() on error or a valid pointer to nvmem_device
1075 struct nvmem_device *devm_nvmem_register(struct device *dev,
1076 const struct nvmem_config *config)
1078 struct nvmem_device *nvmem;
1081 nvmem = nvmem_register(config);
1085 ret = devm_add_action_or_reset(dev, devm_nvmem_unregister, nvmem);
1087 return ERR_PTR(ret);
1091 EXPORT_SYMBOL_GPL(devm_nvmem_register);
1093 static struct nvmem_device *__nvmem_device_get(void *data,
1094 int (*match)(struct device *dev, const void *data))
1096 struct nvmem_device *nvmem = NULL;
1099 mutex_lock(&nvmem_mutex);
1100 dev = bus_find_device(&nvmem_bus_type, NULL, data, match);
1102 nvmem = to_nvmem_device(dev);
1103 mutex_unlock(&nvmem_mutex);
1105 return ERR_PTR(-EPROBE_DEFER);
1107 if (!try_module_get(nvmem->owner)) {
1108 dev_err(&nvmem->dev,
1109 "could not increase module refcount for cell %s\n",
1110 nvmem_dev_name(nvmem));
1112 put_device(&nvmem->dev);
1113 return ERR_PTR(-EINVAL);
1116 kref_get(&nvmem->refcnt);
1121 static void __nvmem_device_put(struct nvmem_device *nvmem)
1123 put_device(&nvmem->dev);
1124 module_put(nvmem->owner);
1125 kref_put(&nvmem->refcnt, nvmem_device_release);
1128 #if IS_ENABLED(CONFIG_OF)
1130 * of_nvmem_device_get() - Get nvmem device from a given id
1132 * @np: Device tree node that uses the nvmem device.
1133 * @id: nvmem name from nvmem-names property.
1135 * Return: ERR_PTR() on error or a valid pointer to a struct nvmem_device
1138 struct nvmem_device *of_nvmem_device_get(struct device_node *np, const char *id)
1141 struct device_node *nvmem_np;
1142 struct nvmem_device *nvmem;
1146 index = of_property_match_string(np, "nvmem-names", id);
1148 nvmem_np = of_parse_phandle(np, "nvmem", index);
1150 return ERR_PTR(-ENOENT);
1152 nvmem = __nvmem_device_get(nvmem_np, device_match_of_node);
1153 of_node_put(nvmem_np);
1156 EXPORT_SYMBOL_GPL(of_nvmem_device_get);
1160 * nvmem_device_get() - Get nvmem device from a given id
1162 * @dev: Device that uses the nvmem device.
1163 * @dev_name: name of the requested nvmem device.
1165 * Return: ERR_PTR() on error or a valid pointer to a struct nvmem_device
1168 struct nvmem_device *nvmem_device_get(struct device *dev, const char *dev_name)
1170 if (dev->of_node) { /* try dt first */
1171 struct nvmem_device *nvmem;
1173 nvmem = of_nvmem_device_get(dev->of_node, dev_name);
1175 if (!IS_ERR(nvmem) || PTR_ERR(nvmem) == -EPROBE_DEFER)
1180 return __nvmem_device_get((void *)dev_name, device_match_name);
1182 EXPORT_SYMBOL_GPL(nvmem_device_get);
1185 * nvmem_device_find() - Find nvmem device with matching function
1187 * @data: Data to pass to match function
1188 * @match: Callback function to check device
1190 * Return: ERR_PTR() on error or a valid pointer to a struct nvmem_device
1193 struct nvmem_device *nvmem_device_find(void *data,
1194 int (*match)(struct device *dev, const void *data))
1196 return __nvmem_device_get(data, match);
1198 EXPORT_SYMBOL_GPL(nvmem_device_find);
1200 static int devm_nvmem_device_match(struct device *dev, void *res, void *data)
1202 struct nvmem_device **nvmem = res;
1204 if (WARN_ON(!nvmem || !*nvmem))
1207 return *nvmem == data;
1210 static void devm_nvmem_device_release(struct device *dev, void *res)
1212 nvmem_device_put(*(struct nvmem_device **)res);
1216 * devm_nvmem_device_put() - put alredy got nvmem device
1218 * @dev: Device that uses the nvmem device.
1219 * @nvmem: pointer to nvmem device allocated by devm_nvmem_cell_get(),
1220 * that needs to be released.
1222 void devm_nvmem_device_put(struct device *dev, struct nvmem_device *nvmem)
1226 ret = devres_release(dev, devm_nvmem_device_release,
1227 devm_nvmem_device_match, nvmem);
1231 EXPORT_SYMBOL_GPL(devm_nvmem_device_put);
1234 * nvmem_device_put() - put alredy got nvmem device
1236 * @nvmem: pointer to nvmem device that needs to be released.
1238 void nvmem_device_put(struct nvmem_device *nvmem)
1240 __nvmem_device_put(nvmem);
1242 EXPORT_SYMBOL_GPL(nvmem_device_put);
1245 * devm_nvmem_device_get() - Get nvmem cell of device form a given id
1247 * @dev: Device that requests the nvmem device.
1248 * @id: name id for the requested nvmem device.
1250 * Return: ERR_PTR() on error or a valid pointer to a struct nvmem_cell
1251 * on success. The nvmem_cell will be freed by the automatically once the
1254 struct nvmem_device *devm_nvmem_device_get(struct device *dev, const char *id)
1256 struct nvmem_device **ptr, *nvmem;
1258 ptr = devres_alloc(devm_nvmem_device_release, sizeof(*ptr), GFP_KERNEL);
1260 return ERR_PTR(-ENOMEM);
1262 nvmem = nvmem_device_get(dev, id);
1263 if (!IS_ERR(nvmem)) {
1265 devres_add(dev, ptr);
1272 EXPORT_SYMBOL_GPL(devm_nvmem_device_get);
1274 static struct nvmem_cell *nvmem_create_cell(struct nvmem_cell_entry *entry,
1275 const char *id, int index)
1277 struct nvmem_cell *cell;
1278 const char *name = NULL;
1280 cell = kzalloc(sizeof(*cell), GFP_KERNEL);
1282 return ERR_PTR(-ENOMEM);
1285 name = kstrdup_const(id, GFP_KERNEL);
1288 return ERR_PTR(-ENOMEM);
1293 cell->entry = entry;
1294 cell->index = index;
1299 static struct nvmem_cell *
1300 nvmem_cell_get_from_lookup(struct device *dev, const char *con_id)
1302 struct nvmem_cell_entry *cell_entry;
1303 struct nvmem_cell *cell = ERR_PTR(-ENOENT);
1304 struct nvmem_cell_lookup *lookup;
1305 struct nvmem_device *nvmem;
1309 return ERR_PTR(-EINVAL);
1311 dev_id = dev_name(dev);
1313 mutex_lock(&nvmem_lookup_mutex);
1315 list_for_each_entry(lookup, &nvmem_lookup_list, node) {
1316 if ((strcmp(lookup->dev_id, dev_id) == 0) &&
1317 (strcmp(lookup->con_id, con_id) == 0)) {
1318 /* This is the right entry. */
1319 nvmem = __nvmem_device_get((void *)lookup->nvmem_name,
1321 if (IS_ERR(nvmem)) {
1322 /* Provider may not be registered yet. */
1323 cell = ERR_CAST(nvmem);
1327 cell_entry = nvmem_find_cell_entry_by_name(nvmem,
1330 __nvmem_device_put(nvmem);
1331 cell = ERR_PTR(-ENOENT);
1333 cell = nvmem_create_cell(cell_entry, con_id, 0);
1335 __nvmem_device_put(nvmem);
1341 mutex_unlock(&nvmem_lookup_mutex);
1345 #if IS_ENABLED(CONFIG_OF)
1346 static struct nvmem_cell_entry *
1347 nvmem_find_cell_entry_by_node(struct nvmem_device *nvmem, struct device_node *np)
1349 struct nvmem_cell_entry *iter, *cell = NULL;
1351 mutex_lock(&nvmem_mutex);
1352 list_for_each_entry(iter, &nvmem->cells, node) {
1353 if (np == iter->np) {
1358 mutex_unlock(&nvmem_mutex);
1364 * of_nvmem_cell_get() - Get a nvmem cell from given device node and cell id
1366 * @np: Device tree node that uses the nvmem cell.
1367 * @id: nvmem cell name from nvmem-cell-names property, or NULL
1368 * for the cell at index 0 (the lone cell with no accompanying
1369 * nvmem-cell-names property).
1371 * Return: Will be an ERR_PTR() on error or a valid pointer
1372 * to a struct nvmem_cell. The nvmem_cell will be freed by the
1375 struct nvmem_cell *of_nvmem_cell_get(struct device_node *np, const char *id)
1377 struct device_node *cell_np, *nvmem_np;
1378 struct nvmem_device *nvmem;
1379 struct nvmem_cell_entry *cell_entry;
1380 struct nvmem_cell *cell;
1381 struct of_phandle_args cell_spec;
1386 /* if cell name exists, find index to the name */
1388 index = of_property_match_string(np, "nvmem-cell-names", id);
1390 ret = of_parse_phandle_with_optional_args(np, "nvmem-cells",
1391 "#nvmem-cell-cells",
1394 return ERR_PTR(-ENOENT);
1396 if (cell_spec.args_count > 1)
1397 return ERR_PTR(-EINVAL);
1399 cell_np = cell_spec.np;
1400 if (cell_spec.args_count)
1401 cell_index = cell_spec.args[0];
1403 nvmem_np = of_get_parent(cell_np);
1405 of_node_put(cell_np);
1406 return ERR_PTR(-EINVAL);
1409 /* nvmem layouts produce cells within the nvmem-layout container */
1410 if (of_node_name_eq(nvmem_np, "nvmem-layout")) {
1411 nvmem_np = of_get_next_parent(nvmem_np);
1413 of_node_put(cell_np);
1414 return ERR_PTR(-EINVAL);
1418 nvmem = __nvmem_device_get(nvmem_np, device_match_of_node);
1419 of_node_put(nvmem_np);
1420 if (IS_ERR(nvmem)) {
1421 of_node_put(cell_np);
1422 return ERR_CAST(nvmem);
1425 cell_entry = nvmem_find_cell_entry_by_node(nvmem, cell_np);
1426 of_node_put(cell_np);
1428 __nvmem_device_put(nvmem);
1429 return ERR_PTR(-ENOENT);
1432 cell = nvmem_create_cell(cell_entry, id, cell_index);
1434 __nvmem_device_put(nvmem);
1438 EXPORT_SYMBOL_GPL(of_nvmem_cell_get);
1442 * nvmem_cell_get() - Get nvmem cell of device form a given cell name
1444 * @dev: Device that requests the nvmem cell.
1445 * @id: nvmem cell name to get (this corresponds with the name from the
1446 * nvmem-cell-names property for DT systems and with the con_id from
1447 * the lookup entry for non-DT systems).
1449 * Return: Will be an ERR_PTR() on error or a valid pointer
1450 * to a struct nvmem_cell. The nvmem_cell will be freed by the
1453 struct nvmem_cell *nvmem_cell_get(struct device *dev, const char *id)
1455 struct nvmem_cell *cell;
1457 if (dev->of_node) { /* try dt first */
1458 cell = of_nvmem_cell_get(dev->of_node, id);
1459 if (!IS_ERR(cell) || PTR_ERR(cell) == -EPROBE_DEFER)
1463 /* NULL cell id only allowed for device tree; invalid otherwise */
1465 return ERR_PTR(-EINVAL);
1467 return nvmem_cell_get_from_lookup(dev, id);
1469 EXPORT_SYMBOL_GPL(nvmem_cell_get);
1471 static void devm_nvmem_cell_release(struct device *dev, void *res)
1473 nvmem_cell_put(*(struct nvmem_cell **)res);
1477 * devm_nvmem_cell_get() - Get nvmem cell of device form a given id
1479 * @dev: Device that requests the nvmem cell.
1480 * @id: nvmem cell name id to get.
1482 * Return: Will be an ERR_PTR() on error or a valid pointer
1483 * to a struct nvmem_cell. The nvmem_cell will be freed by the
1484 * automatically once the device is freed.
1486 struct nvmem_cell *devm_nvmem_cell_get(struct device *dev, const char *id)
1488 struct nvmem_cell **ptr, *cell;
1490 ptr = devres_alloc(devm_nvmem_cell_release, sizeof(*ptr), GFP_KERNEL);
1492 return ERR_PTR(-ENOMEM);
1494 cell = nvmem_cell_get(dev, id);
1495 if (!IS_ERR(cell)) {
1497 devres_add(dev, ptr);
1504 EXPORT_SYMBOL_GPL(devm_nvmem_cell_get);
1506 static int devm_nvmem_cell_match(struct device *dev, void *res, void *data)
1508 struct nvmem_cell **c = res;
1510 if (WARN_ON(!c || !*c))
1517 * devm_nvmem_cell_put() - Release previously allocated nvmem cell
1518 * from devm_nvmem_cell_get.
1520 * @dev: Device that requests the nvmem cell.
1521 * @cell: Previously allocated nvmem cell by devm_nvmem_cell_get().
1523 void devm_nvmem_cell_put(struct device *dev, struct nvmem_cell *cell)
1527 ret = devres_release(dev, devm_nvmem_cell_release,
1528 devm_nvmem_cell_match, cell);
1532 EXPORT_SYMBOL(devm_nvmem_cell_put);
1535 * nvmem_cell_put() - Release previously allocated nvmem cell.
1537 * @cell: Previously allocated nvmem cell by nvmem_cell_get().
1539 void nvmem_cell_put(struct nvmem_cell *cell)
1541 struct nvmem_device *nvmem = cell->entry->nvmem;
1544 kfree_const(cell->id);
1547 __nvmem_device_put(nvmem);
1549 EXPORT_SYMBOL_GPL(nvmem_cell_put);
1551 static void nvmem_shift_read_buffer_in_place(struct nvmem_cell_entry *cell, void *buf)
1554 int i, extra, bit_offset = cell->bit_offset;
1559 *b++ >>= bit_offset;
1561 /* setup rest of the bytes if any */
1562 for (i = 1; i < cell->bytes; i++) {
1563 /* Get bits from next byte and shift them towards msb */
1564 *p |= *b << (BITS_PER_BYTE - bit_offset);
1567 *b++ >>= bit_offset;
1570 /* point to the msb */
1571 p += cell->bytes - 1;
1574 /* result fits in less bytes */
1575 extra = cell->bytes - DIV_ROUND_UP(cell->nbits, BITS_PER_BYTE);
1576 while (--extra >= 0)
1579 /* clear msb bits if any leftover in the last byte */
1580 if (cell->nbits % BITS_PER_BYTE)
1581 *p &= GENMASK((cell->nbits % BITS_PER_BYTE) - 1, 0);
1584 static int __nvmem_cell_read(struct nvmem_device *nvmem,
1585 struct nvmem_cell_entry *cell,
1586 void *buf, size_t *len, const char *id, int index)
1590 rc = nvmem_reg_read(nvmem, cell->offset, buf, cell->raw_len);
1595 /* shift bits in-place */
1596 if (cell->bit_offset || cell->nbits)
1597 nvmem_shift_read_buffer_in_place(cell, buf);
1599 if (cell->read_post_process) {
1600 rc = cell->read_post_process(cell->priv, id, index,
1601 cell->offset, buf, cell->raw_len);
1613 * nvmem_cell_read() - Read a given nvmem cell
1615 * @cell: nvmem cell to be read.
1616 * @len: pointer to length of cell which will be populated on successful read;
1619 * Return: ERR_PTR() on error or a valid pointer to a buffer on success. The
1620 * buffer should be freed by the consumer with a kfree().
1622 void *nvmem_cell_read(struct nvmem_cell *cell, size_t *len)
1624 struct nvmem_cell_entry *entry = cell->entry;
1625 struct nvmem_device *nvmem = entry->nvmem;
1630 return ERR_PTR(-EINVAL);
1632 buf = kzalloc(max_t(size_t, entry->raw_len, entry->bytes), GFP_KERNEL);
1634 return ERR_PTR(-ENOMEM);
1636 rc = __nvmem_cell_read(nvmem, cell->entry, buf, len, cell->id, cell->index);
1644 EXPORT_SYMBOL_GPL(nvmem_cell_read);
1646 static void *nvmem_cell_prepare_write_buffer(struct nvmem_cell_entry *cell,
1649 struct nvmem_device *nvmem = cell->nvmem;
1650 int i, rc, nbits, bit_offset = cell->bit_offset;
1651 u8 v, *p, *buf, *b, pbyte, pbits;
1653 nbits = cell->nbits;
1654 buf = kzalloc(cell->bytes, GFP_KERNEL);
1656 return ERR_PTR(-ENOMEM);
1658 memcpy(buf, _buf, len);
1665 /* setup the first byte with lsb bits from nvmem */
1666 rc = nvmem_reg_read(nvmem, cell->offset, &v, 1);
1669 *b++ |= GENMASK(bit_offset - 1, 0) & v;
1671 /* setup rest of the byte if any */
1672 for (i = 1; i < cell->bytes; i++) {
1673 /* Get last byte bits and shift them towards lsb */
1674 pbits = pbyte >> (BITS_PER_BYTE - 1 - bit_offset);
1682 /* if it's not end on byte boundary */
1683 if ((nbits + bit_offset) % BITS_PER_BYTE) {
1684 /* setup the last byte with msb bits from nvmem */
1685 rc = nvmem_reg_read(nvmem,
1686 cell->offset + cell->bytes - 1, &v, 1);
1689 *p |= GENMASK(7, (nbits + bit_offset) % BITS_PER_BYTE) & v;
1699 static int __nvmem_cell_entry_write(struct nvmem_cell_entry *cell, void *buf, size_t len)
1701 struct nvmem_device *nvmem = cell->nvmem;
1704 if (!nvmem || nvmem->read_only ||
1705 (cell->bit_offset == 0 && len != cell->bytes))
1709 * Any cells which have a read_post_process hook are read-only because
1710 * we cannot reverse the operation and it might affect other cells,
1713 if (cell->read_post_process)
1716 if (cell->bit_offset || cell->nbits) {
1717 buf = nvmem_cell_prepare_write_buffer(cell, buf, len);
1719 return PTR_ERR(buf);
1722 rc = nvmem_reg_write(nvmem, cell->offset, buf, cell->bytes);
1724 /* free the tmp buffer */
1725 if (cell->bit_offset || cell->nbits)
1735 * nvmem_cell_write() - Write to a given nvmem cell
1737 * @cell: nvmem cell to be written.
1738 * @buf: Buffer to be written.
1739 * @len: length of buffer to be written to nvmem cell.
1741 * Return: length of bytes written or negative on failure.
1743 int nvmem_cell_write(struct nvmem_cell *cell, void *buf, size_t len)
1745 return __nvmem_cell_entry_write(cell->entry, buf, len);
1748 EXPORT_SYMBOL_GPL(nvmem_cell_write);
1750 static int nvmem_cell_read_common(struct device *dev, const char *cell_id,
1751 void *val, size_t count)
1753 struct nvmem_cell *cell;
1757 cell = nvmem_cell_get(dev, cell_id);
1759 return PTR_ERR(cell);
1761 buf = nvmem_cell_read(cell, &len);
1763 nvmem_cell_put(cell);
1764 return PTR_ERR(buf);
1768 nvmem_cell_put(cell);
1771 memcpy(val, buf, count);
1773 nvmem_cell_put(cell);
1779 * nvmem_cell_read_u8() - Read a cell value as a u8
1781 * @dev: Device that requests the nvmem cell.
1782 * @cell_id: Name of nvmem cell to read.
1783 * @val: pointer to output value.
1785 * Return: 0 on success or negative errno.
1787 int nvmem_cell_read_u8(struct device *dev, const char *cell_id, u8 *val)
1789 return nvmem_cell_read_common(dev, cell_id, val, sizeof(*val));
1791 EXPORT_SYMBOL_GPL(nvmem_cell_read_u8);
1794 * nvmem_cell_read_u16() - Read a cell value as a u16
1796 * @dev: Device that requests the nvmem cell.
1797 * @cell_id: Name of nvmem cell to read.
1798 * @val: pointer to output value.
1800 * Return: 0 on success or negative errno.
1802 int nvmem_cell_read_u16(struct device *dev, const char *cell_id, u16 *val)
1804 return nvmem_cell_read_common(dev, cell_id, val, sizeof(*val));
1806 EXPORT_SYMBOL_GPL(nvmem_cell_read_u16);
1809 * nvmem_cell_read_u32() - Read a cell value as a u32
1811 * @dev: Device that requests the nvmem cell.
1812 * @cell_id: Name of nvmem cell to read.
1813 * @val: pointer to output value.
1815 * Return: 0 on success or negative errno.
1817 int nvmem_cell_read_u32(struct device *dev, const char *cell_id, u32 *val)
1819 return nvmem_cell_read_common(dev, cell_id, val, sizeof(*val));
1821 EXPORT_SYMBOL_GPL(nvmem_cell_read_u32);
1824 * nvmem_cell_read_u64() - Read a cell value as a u64
1826 * @dev: Device that requests the nvmem cell.
1827 * @cell_id: Name of nvmem cell to read.
1828 * @val: pointer to output value.
1830 * Return: 0 on success or negative errno.
1832 int nvmem_cell_read_u64(struct device *dev, const char *cell_id, u64 *val)
1834 return nvmem_cell_read_common(dev, cell_id, val, sizeof(*val));
1836 EXPORT_SYMBOL_GPL(nvmem_cell_read_u64);
1838 static const void *nvmem_cell_read_variable_common(struct device *dev,
1839 const char *cell_id,
1840 size_t max_len, size_t *len)
1842 struct nvmem_cell *cell;
1846 cell = nvmem_cell_get(dev, cell_id);
1850 nbits = cell->entry->nbits;
1851 buf = nvmem_cell_read(cell, len);
1852 nvmem_cell_put(cell);
1857 * If nbits is set then nvmem_cell_read() can significantly exaggerate
1858 * the length of the real data. Throw away the extra junk.
1861 *len = DIV_ROUND_UP(nbits, 8);
1863 if (*len > max_len) {
1865 return ERR_PTR(-ERANGE);
1872 * nvmem_cell_read_variable_le_u32() - Read up to 32-bits of data as a little endian number.
1874 * @dev: Device that requests the nvmem cell.
1875 * @cell_id: Name of nvmem cell to read.
1876 * @val: pointer to output value.
1878 * Return: 0 on success or negative errno.
1880 int nvmem_cell_read_variable_le_u32(struct device *dev, const char *cell_id,
1887 buf = nvmem_cell_read_variable_common(dev, cell_id, sizeof(*val), &len);
1889 return PTR_ERR(buf);
1891 /* Copy w/ implicit endian conversion */
1893 for (i = 0; i < len; i++)
1894 *val |= buf[i] << (8 * i);
1900 EXPORT_SYMBOL_GPL(nvmem_cell_read_variable_le_u32);
1903 * nvmem_cell_read_variable_le_u64() - Read up to 64-bits of data as a little endian number.
1905 * @dev: Device that requests the nvmem cell.
1906 * @cell_id: Name of nvmem cell to read.
1907 * @val: pointer to output value.
1909 * Return: 0 on success or negative errno.
1911 int nvmem_cell_read_variable_le_u64(struct device *dev, const char *cell_id,
1918 buf = nvmem_cell_read_variable_common(dev, cell_id, sizeof(*val), &len);
1920 return PTR_ERR(buf);
1922 /* Copy w/ implicit endian conversion */
1924 for (i = 0; i < len; i++)
1925 *val |= (uint64_t)buf[i] << (8 * i);
1931 EXPORT_SYMBOL_GPL(nvmem_cell_read_variable_le_u64);
1934 * nvmem_device_cell_read() - Read a given nvmem device and cell
1936 * @nvmem: nvmem device to read from.
1937 * @info: nvmem cell info to be read.
1938 * @buf: buffer pointer which will be populated on successful read.
1940 * Return: length of successful bytes read on success and negative
1941 * error code on error.
1943 ssize_t nvmem_device_cell_read(struct nvmem_device *nvmem,
1944 struct nvmem_cell_info *info, void *buf)
1946 struct nvmem_cell_entry cell;
1953 rc = nvmem_cell_info_to_nvmem_cell_entry_nodup(nvmem, info, &cell);
1957 rc = __nvmem_cell_read(nvmem, &cell, buf, &len, NULL, 0);
1963 EXPORT_SYMBOL_GPL(nvmem_device_cell_read);
1966 * nvmem_device_cell_write() - Write cell to a given nvmem device
1968 * @nvmem: nvmem device to be written to.
1969 * @info: nvmem cell info to be written.
1970 * @buf: buffer to be written to cell.
1972 * Return: length of bytes written or negative error code on failure.
1974 int nvmem_device_cell_write(struct nvmem_device *nvmem,
1975 struct nvmem_cell_info *info, void *buf)
1977 struct nvmem_cell_entry cell;
1983 rc = nvmem_cell_info_to_nvmem_cell_entry_nodup(nvmem, info, &cell);
1987 return __nvmem_cell_entry_write(&cell, buf, cell.bytes);
1989 EXPORT_SYMBOL_GPL(nvmem_device_cell_write);
1992 * nvmem_device_read() - Read from a given nvmem device
1994 * @nvmem: nvmem device to read from.
1995 * @offset: offset in nvmem device.
1996 * @bytes: number of bytes to read.
1997 * @buf: buffer pointer which will be populated on successful read.
1999 * Return: length of successful bytes read on success and negative
2000 * error code on error.
2002 int nvmem_device_read(struct nvmem_device *nvmem,
2003 unsigned int offset,
2004 size_t bytes, void *buf)
2011 rc = nvmem_reg_read(nvmem, offset, buf, bytes);
2018 EXPORT_SYMBOL_GPL(nvmem_device_read);
2021 * nvmem_device_write() - Write cell to a given nvmem device
2023 * @nvmem: nvmem device to be written to.
2024 * @offset: offset in nvmem device.
2025 * @bytes: number of bytes to write.
2026 * @buf: buffer to be written.
2028 * Return: length of bytes written or negative error code on failure.
2030 int nvmem_device_write(struct nvmem_device *nvmem,
2031 unsigned int offset,
2032 size_t bytes, void *buf)
2039 rc = nvmem_reg_write(nvmem, offset, buf, bytes);
2047 EXPORT_SYMBOL_GPL(nvmem_device_write);
2050 * nvmem_add_cell_table() - register a table of cell info entries
2052 * @table: table of cell info entries
2054 void nvmem_add_cell_table(struct nvmem_cell_table *table)
2056 mutex_lock(&nvmem_cell_mutex);
2057 list_add_tail(&table->node, &nvmem_cell_tables);
2058 mutex_unlock(&nvmem_cell_mutex);
2060 EXPORT_SYMBOL_GPL(nvmem_add_cell_table);
2063 * nvmem_del_cell_table() - remove a previously registered cell info table
2065 * @table: table of cell info entries
2067 void nvmem_del_cell_table(struct nvmem_cell_table *table)
2069 mutex_lock(&nvmem_cell_mutex);
2070 list_del(&table->node);
2071 mutex_unlock(&nvmem_cell_mutex);
2073 EXPORT_SYMBOL_GPL(nvmem_del_cell_table);
2076 * nvmem_add_cell_lookups() - register a list of cell lookup entries
2078 * @entries: array of cell lookup entries
2079 * @nentries: number of cell lookup entries in the array
2081 void nvmem_add_cell_lookups(struct nvmem_cell_lookup *entries, size_t nentries)
2085 mutex_lock(&nvmem_lookup_mutex);
2086 for (i = 0; i < nentries; i++)
2087 list_add_tail(&entries[i].node, &nvmem_lookup_list);
2088 mutex_unlock(&nvmem_lookup_mutex);
2090 EXPORT_SYMBOL_GPL(nvmem_add_cell_lookups);
2093 * nvmem_del_cell_lookups() - remove a list of previously added cell lookup
2096 * @entries: array of cell lookup entries
2097 * @nentries: number of cell lookup entries in the array
2099 void nvmem_del_cell_lookups(struct nvmem_cell_lookup *entries, size_t nentries)
2103 mutex_lock(&nvmem_lookup_mutex);
2104 for (i = 0; i < nentries; i++)
2105 list_del(&entries[i].node);
2106 mutex_unlock(&nvmem_lookup_mutex);
2108 EXPORT_SYMBOL_GPL(nvmem_del_cell_lookups);
2111 * nvmem_dev_name() - Get the name of a given nvmem device.
2113 * @nvmem: nvmem device.
2115 * Return: name of the nvmem device.
2117 const char *nvmem_dev_name(struct nvmem_device *nvmem)
2119 return dev_name(&nvmem->dev);
2121 EXPORT_SYMBOL_GPL(nvmem_dev_name);
2123 static int __init nvmem_init(void)
2125 return bus_register(&nvmem_bus_type);
2128 static void __exit nvmem_exit(void)
2130 bus_unregister(&nvmem_bus_type);
2133 subsys_initcall(nvmem_init);
2134 module_exit(nvmem_exit);
2136 MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org");
2137 MODULE_AUTHOR("Maxime Ripard <maxime.ripard@free-electrons.com");
2138 MODULE_DESCRIPTION("nvmem Driver Core");