Lines Matching +full:nvmem +full:- +full:layout
1 // SPDX-License-Identifier: GPL-2.0
3 * nvmem framework core.
6 * Copyright (C) 2013 Maxime Ripard <maxime.ripard@free-electrons.com>
16 #include <linux/nvmem-consumer.h>
17 #include <linux/nvmem-provider.h>
42 struct nvmem_layout *layout; member
59 struct nvmem_device *nvmem; member
83 static int __nvmem_reg_read(struct nvmem_device *nvmem, unsigned int offset, in __nvmem_reg_read() argument
86 if (nvmem->reg_read) in __nvmem_reg_read()
87 return nvmem->reg_read(nvmem->priv, offset, val, bytes); in __nvmem_reg_read()
89 return -EINVAL; in __nvmem_reg_read()
92 static int __nvmem_reg_write(struct nvmem_device *nvmem, unsigned int offset, in __nvmem_reg_write() argument
97 if (nvmem->reg_write) { in __nvmem_reg_write()
98 gpiod_set_value_cansleep(nvmem->wp_gpio, 0); in __nvmem_reg_write()
99 ret = nvmem->reg_write(nvmem->priv, offset, val, bytes); in __nvmem_reg_write()
100 gpiod_set_value_cansleep(nvmem->wp_gpio, 1); in __nvmem_reg_write()
104 return -EINVAL; in __nvmem_reg_write()
107 static int nvmem_access_with_keepouts(struct nvmem_device *nvmem, in nvmem_access_with_keepouts() argument
114 const struct nvmem_keepout *keepout = nvmem->keepout; in nvmem_access_with_keepouts()
115 const struct nvmem_keepout *keepoutend = keepout + nvmem->nkeepout; in nvmem_access_with_keepouts()
122 while ((keepout < keepoutend) && (keepout->end <= offset)) in nvmem_access_with_keepouts()
127 if (offset < keepout->start) { in nvmem_access_with_keepouts()
128 kend = min(end, keepout->start); in nvmem_access_with_keepouts()
129 ksize = kend - offset; in nvmem_access_with_keepouts()
131 rc = __nvmem_reg_write(nvmem, offset, val, ksize); in nvmem_access_with_keepouts()
133 rc = __nvmem_reg_read(nvmem, offset, val, ksize); in nvmem_access_with_keepouts()
146 kend = min(end, keepout->end); in nvmem_access_with_keepouts()
147 ksize = kend - offset; in nvmem_access_with_keepouts()
149 memset(val, keepout->value, ksize); in nvmem_access_with_keepouts()
161 ksize = end - offset; in nvmem_access_with_keepouts()
163 return __nvmem_reg_write(nvmem, offset, val, ksize); in nvmem_access_with_keepouts()
165 return __nvmem_reg_read(nvmem, offset, val, ksize); in nvmem_access_with_keepouts()
171 static int nvmem_reg_read(struct nvmem_device *nvmem, unsigned int offset, in nvmem_reg_read() argument
174 if (!nvmem->nkeepout) in nvmem_reg_read()
175 return __nvmem_reg_read(nvmem, offset, val, bytes); in nvmem_reg_read()
177 return nvmem_access_with_keepouts(nvmem, offset, val, bytes, false); in nvmem_reg_read()
180 static int nvmem_reg_write(struct nvmem_device *nvmem, unsigned int offset, in nvmem_reg_write() argument
183 if (!nvmem->nkeepout) in nvmem_reg_write()
184 return __nvmem_reg_write(nvmem, offset, val, bytes); in nvmem_reg_write()
186 return nvmem_access_with_keepouts(nvmem, offset, val, bytes, true); in nvmem_reg_write()
205 struct nvmem_device *nvmem = to_nvmem_device(dev); in type_show() local
207 return sprintf(buf, "%s\n", nvmem_type_str[nvmem->type]); in type_show()
222 struct nvmem_device *nvmem; in bin_attr_nvmem_read() local
225 if (attr->private) in bin_attr_nvmem_read()
226 dev = attr->private; in bin_attr_nvmem_read()
229 nvmem = to_nvmem_device(dev); in bin_attr_nvmem_read()
232 if (pos >= nvmem->size) in bin_attr_nvmem_read()
235 if (!IS_ALIGNED(pos, nvmem->stride)) in bin_attr_nvmem_read()
236 return -EINVAL; in bin_attr_nvmem_read()
238 if (count < nvmem->word_size) in bin_attr_nvmem_read()
239 return -EINVAL; in bin_attr_nvmem_read()
241 if (pos + count > nvmem->size) in bin_attr_nvmem_read()
242 count = nvmem->size - pos; in bin_attr_nvmem_read()
244 count = round_down(count, nvmem->word_size); in bin_attr_nvmem_read()
246 if (!nvmem->reg_read) in bin_attr_nvmem_read()
247 return -EPERM; in bin_attr_nvmem_read()
249 rc = nvmem_reg_read(nvmem, pos, buf, count); in bin_attr_nvmem_read()
262 struct nvmem_device *nvmem; in bin_attr_nvmem_write() local
265 if (attr->private) in bin_attr_nvmem_write()
266 dev = attr->private; in bin_attr_nvmem_write()
269 nvmem = to_nvmem_device(dev); in bin_attr_nvmem_write()
272 if (pos >= nvmem->size) in bin_attr_nvmem_write()
273 return -EFBIG; in bin_attr_nvmem_write()
275 if (!IS_ALIGNED(pos, nvmem->stride)) in bin_attr_nvmem_write()
276 return -EINVAL; in bin_attr_nvmem_write()
278 if (count < nvmem->word_size) in bin_attr_nvmem_write()
279 return -EINVAL; in bin_attr_nvmem_write()
281 if (pos + count > nvmem->size) in bin_attr_nvmem_write()
282 count = nvmem->size - pos; in bin_attr_nvmem_write()
284 count = round_down(count, nvmem->word_size); in bin_attr_nvmem_write()
286 if (!nvmem->reg_write) in bin_attr_nvmem_write()
287 return -EPERM; in bin_attr_nvmem_write()
289 rc = nvmem_reg_write(nvmem, pos, buf, count); in bin_attr_nvmem_write()
297 static umode_t nvmem_bin_attr_get_umode(struct nvmem_device *nvmem) in nvmem_bin_attr_get_umode() argument
301 if (!nvmem->root_only) in nvmem_bin_attr_get_umode()
304 if (!nvmem->read_only) in nvmem_bin_attr_get_umode()
307 if (!nvmem->reg_write) in nvmem_bin_attr_get_umode()
310 if (!nvmem->reg_read) in nvmem_bin_attr_get_umode()
320 struct nvmem_device *nvmem = to_nvmem_device(dev); in nvmem_bin_attr_is_visible() local
322 attr->size = nvmem->size; in nvmem_bin_attr_is_visible()
324 return nvmem_bin_attr_get_umode(nvmem); in nvmem_bin_attr_is_visible()
330 .name = "nvmem",
362 * nvmem_setup_compat() - Create an additional binary entry in
366 static int nvmem_sysfs_setup_compat(struct nvmem_device *nvmem, in nvmem_sysfs_setup_compat() argument
371 if (!config->compat) in nvmem_sysfs_setup_compat()
374 if (!config->base_dev) in nvmem_sysfs_setup_compat()
375 return -EINVAL; in nvmem_sysfs_setup_compat()
377 if (config->type == NVMEM_TYPE_FRAM) in nvmem_sysfs_setup_compat()
380 nvmem->eeprom = bin_attr_nvmem_eeprom_compat; in nvmem_sysfs_setup_compat()
381 nvmem->eeprom.attr.mode = nvmem_bin_attr_get_umode(nvmem); in nvmem_sysfs_setup_compat()
382 nvmem->eeprom.size = nvmem->size; in nvmem_sysfs_setup_compat()
384 nvmem->eeprom.attr.key = &eeprom_lock_key; in nvmem_sysfs_setup_compat()
386 nvmem->eeprom.private = &nvmem->dev; in nvmem_sysfs_setup_compat()
387 nvmem->base_dev = config->base_dev; in nvmem_sysfs_setup_compat()
389 rval = device_create_bin_file(nvmem->base_dev, &nvmem->eeprom); in nvmem_sysfs_setup_compat()
391 dev_err(&nvmem->dev, in nvmem_sysfs_setup_compat()
396 nvmem->flags |= FLAG_COMPAT; in nvmem_sysfs_setup_compat()
401 static void nvmem_sysfs_remove_compat(struct nvmem_device *nvmem, in nvmem_sysfs_remove_compat() argument
404 if (config->compat) in nvmem_sysfs_remove_compat()
405 device_remove_bin_file(nvmem->base_dev, &nvmem->eeprom); in nvmem_sysfs_remove_compat()
410 static int nvmem_sysfs_setup_compat(struct nvmem_device *nvmem, in nvmem_sysfs_setup_compat() argument
413 return -ENOSYS; in nvmem_sysfs_setup_compat()
415 static void nvmem_sysfs_remove_compat(struct nvmem_device *nvmem, in nvmem_sysfs_remove_compat() argument
424 struct nvmem_device *nvmem = to_nvmem_device(dev); in nvmem_release() local
426 ida_free(&nvmem_ida, nvmem->id); in nvmem_release()
427 gpiod_put(nvmem->wp_gpio); in nvmem_release()
428 kfree(nvmem); in nvmem_release()
436 .name = "nvmem",
443 list_del(&cell->node); in nvmem_cell_entry_drop()
445 of_node_put(cell->np); in nvmem_cell_entry_drop()
446 kfree_const(cell->name); in nvmem_cell_entry_drop()
450 static void nvmem_device_remove_all_cells(const struct nvmem_device *nvmem) in nvmem_device_remove_all_cells() argument
454 list_for_each_entry_safe(cell, p, &nvmem->cells, node) in nvmem_device_remove_all_cells()
461 list_add_tail(&cell->node, &cell->nvmem->cells); in nvmem_cell_entry_add()
466 static int nvmem_cell_info_to_nvmem_cell_entry_nodup(struct nvmem_device *nvmem, in nvmem_cell_info_to_nvmem_cell_entry_nodup() argument
470 cell->nvmem = nvmem; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
471 cell->offset = info->offset; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
472 cell->raw_len = info->raw_len ?: info->bytes; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
473 cell->bytes = info->bytes; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
474 cell->name = info->name; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
475 cell->read_post_process = info->read_post_process; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
476 cell->priv = info->priv; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
478 cell->bit_offset = info->bit_offset; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
479 cell->nbits = info->nbits; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
480 cell->np = info->np; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
482 if (cell->nbits) in nvmem_cell_info_to_nvmem_cell_entry_nodup()
483 cell->bytes = DIV_ROUND_UP(cell->nbits + cell->bit_offset, in nvmem_cell_info_to_nvmem_cell_entry_nodup()
486 if (!IS_ALIGNED(cell->offset, nvmem->stride)) { in nvmem_cell_info_to_nvmem_cell_entry_nodup()
487 dev_err(&nvmem->dev, in nvmem_cell_info_to_nvmem_cell_entry_nodup()
488 "cell %s unaligned to nvmem stride %d\n", in nvmem_cell_info_to_nvmem_cell_entry_nodup()
489 cell->name ?: "<unknown>", nvmem->stride); in nvmem_cell_info_to_nvmem_cell_entry_nodup()
490 return -EINVAL; in nvmem_cell_info_to_nvmem_cell_entry_nodup()
496 static int nvmem_cell_info_to_nvmem_cell_entry(struct nvmem_device *nvmem, in nvmem_cell_info_to_nvmem_cell_entry() argument
502 err = nvmem_cell_info_to_nvmem_cell_entry_nodup(nvmem, info, cell); in nvmem_cell_info_to_nvmem_cell_entry()
506 cell->name = kstrdup_const(info->name, GFP_KERNEL); in nvmem_cell_info_to_nvmem_cell_entry()
507 if (!cell->name) in nvmem_cell_info_to_nvmem_cell_entry()
508 return -ENOMEM; in nvmem_cell_info_to_nvmem_cell_entry()
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
521 int nvmem_add_one_cell(struct nvmem_device *nvmem, in nvmem_add_one_cell() argument
529 return -ENOMEM; in nvmem_add_one_cell()
531 rval = nvmem_cell_info_to_nvmem_cell_entry(nvmem, info, cell); in 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
552 static int nvmem_add_cells(struct nvmem_device *nvmem, in nvmem_add_cells() argument
559 rval = nvmem_add_one_cell(nvmem, &info[i]); in nvmem_add_cells()
568 * nvmem_register_notifier() - Register a notifier block for nvmem events.
570 * @nb: notifier block to be called on nvmem events.
581 * nvmem_unregister_notifier() - Unregister a notifier block for nvmem events.
593 static int nvmem_add_cells_from_table(struct nvmem_device *nvmem) in nvmem_add_cells_from_table() argument
602 if (strcmp(nvmem_dev_name(nvmem), table->nvmem_name) == 0) { in nvmem_add_cells_from_table()
603 for (i = 0; i < table->ncells; i++) { in nvmem_add_cells_from_table()
604 info = &table->cells[i]; in nvmem_add_cells_from_table()
608 rval = -ENOMEM; in nvmem_add_cells_from_table()
612 rval = nvmem_cell_info_to_nvmem_cell_entry(nvmem, info, cell); in nvmem_add_cells_from_table()
629 nvmem_find_cell_entry_by_name(struct nvmem_device *nvmem, const char *cell_id) in nvmem_find_cell_entry_by_name() argument
634 list_for_each_entry(iter, &nvmem->cells, node) { in nvmem_find_cell_entry_by_name()
635 if (strcmp(cell_id, iter->name) == 0) { in nvmem_find_cell_entry_by_name()
645 static int nvmem_validate_keepouts(struct nvmem_device *nvmem) in nvmem_validate_keepouts() argument
648 const struct nvmem_keepout *keepout = nvmem->keepout; in nvmem_validate_keepouts()
649 const struct nvmem_keepout *keepoutend = keepout + nvmem->nkeepout; in nvmem_validate_keepouts()
653 if (keepout->start < cur) { in nvmem_validate_keepouts()
654 dev_err(&nvmem->dev, in nvmem_validate_keepouts()
657 return -ERANGE; in nvmem_validate_keepouts()
660 if (keepout->end < keepout->start) { in nvmem_validate_keepouts()
661 dev_err(&nvmem->dev, in nvmem_validate_keepouts()
664 return -EINVAL; in nvmem_validate_keepouts()
671 if ((keepout->end - keepout->start < nvmem->word_size) || in nvmem_validate_keepouts()
672 ((keepout->start != cur) && in nvmem_validate_keepouts()
673 (keepout->start - cur < nvmem->word_size))) { in nvmem_validate_keepouts()
675 dev_err(&nvmem->dev, in nvmem_validate_keepouts()
678 return -ERANGE; in nvmem_validate_keepouts()
682 if (!IS_ALIGNED(keepout->start, nvmem->stride) || in nvmem_validate_keepouts()
683 !IS_ALIGNED(keepout->end, nvmem->stride)) { in nvmem_validate_keepouts()
685 dev_err(&nvmem->dev, in nvmem_validate_keepouts()
688 return -EINVAL; in nvmem_validate_keepouts()
691 cur = keepout->end; in nvmem_validate_keepouts()
698 static int nvmem_add_cells_from_dt(struct nvmem_device *nvmem, struct device_node *np) in nvmem_add_cells_from_dt() argument
700 struct nvmem_layout *layout = nvmem->layout; in nvmem_add_cells_from_dt() local
701 struct device *dev = &nvmem->dev; in nvmem_add_cells_from_dt()
713 dev_err(dev, "nvmem: invalid reg on %pOF\n", child); in nvmem_add_cells_from_dt()
715 return -EINVAL; in nvmem_add_cells_from_dt()
730 if (layout && layout->fixup_cell_info) in nvmem_add_cells_from_dt()
731 layout->fixup_cell_info(nvmem, layout, &info); in nvmem_add_cells_from_dt()
733 ret = nvmem_add_one_cell(nvmem, &info); in nvmem_add_cells_from_dt()
744 static int nvmem_add_cells_from_legacy_of(struct nvmem_device *nvmem) in nvmem_add_cells_from_legacy_of() argument
746 return nvmem_add_cells_from_dt(nvmem, nvmem->dev.of_node); in nvmem_add_cells_from_legacy_of()
749 static int nvmem_add_cells_from_fixed_layout(struct nvmem_device *nvmem) in nvmem_add_cells_from_fixed_layout() argument
754 layout_np = of_nvmem_layout_get_container(nvmem); in nvmem_add_cells_from_fixed_layout()
758 if (of_device_is_compatible(layout_np, "fixed-layout")) in nvmem_add_cells_from_fixed_layout()
759 err = nvmem_add_cells_from_dt(nvmem, layout_np); in nvmem_add_cells_from_fixed_layout()
766 int __nvmem_layout_register(struct nvmem_layout *layout, struct module *owner) in __nvmem_layout_register() argument
768 layout->owner = owner; in __nvmem_layout_register()
771 list_add(&layout->node, &nvmem_layouts); in __nvmem_layout_register()
774 blocking_notifier_call_chain(&nvmem_notifier, NVMEM_LAYOUT_ADD, layout); in __nvmem_layout_register()
780 void nvmem_layout_unregister(struct nvmem_layout *layout) in nvmem_layout_unregister() argument
782 blocking_notifier_call_chain(&nvmem_notifier, NVMEM_LAYOUT_REMOVE, layout); in nvmem_layout_unregister()
785 list_del(&layout->node); in nvmem_layout_unregister()
790 static struct nvmem_layout *nvmem_layout_get(struct nvmem_device *nvmem) in nvmem_layout_get() argument
793 struct nvmem_layout *l, *layout = ERR_PTR(-EPROBE_DEFER); in nvmem_layout_get() local
795 layout_np = of_nvmem_layout_get_container(nvmem); in nvmem_layout_get()
800 * In case the nvmem device was built-in while the layout was built as a in nvmem_layout_get()
801 * module, we shall manually request the layout driver loading otherwise in nvmem_layout_get()
809 if (of_match_node(l->of_match_table, layout_np)) { in nvmem_layout_get()
810 if (try_module_get(l->owner)) in nvmem_layout_get()
811 layout = l; in nvmem_layout_get()
820 return layout; in nvmem_layout_get()
823 static void nvmem_layout_put(struct nvmem_layout *layout) in nvmem_layout_put() argument
825 if (layout) in nvmem_layout_put()
826 module_put(layout->owner); in nvmem_layout_put()
829 static int nvmem_add_cells_from_layout(struct nvmem_device *nvmem) in nvmem_add_cells_from_layout() argument
831 struct nvmem_layout *layout = nvmem->layout; in nvmem_add_cells_from_layout() local
834 if (layout && layout->add_cells) { in nvmem_add_cells_from_layout()
835 ret = layout->add_cells(&nvmem->dev, nvmem, layout); in nvmem_add_cells_from_layout()
845 * of_nvmem_layout_get_container() - Get OF node to layout container.
847 * @nvmem: nvmem device.
852 struct device_node *of_nvmem_layout_get_container(struct nvmem_device *nvmem) in of_nvmem_layout_get_container() argument
854 return of_get_child_by_name(nvmem->dev.of_node, "nvmem-layout"); in of_nvmem_layout_get_container()
859 const void *nvmem_layout_get_match_data(struct nvmem_device *nvmem, in nvmem_layout_get_match_data() argument
860 struct nvmem_layout *layout) in nvmem_layout_get_match_data() argument
865 layout_np = of_nvmem_layout_get_container(nvmem); in nvmem_layout_get_match_data()
866 match = of_match_node(layout->of_match_table, layout_np); in nvmem_layout_get_match_data()
868 return match ? match->data : NULL; in nvmem_layout_get_match_data()
873 * nvmem_register() - Register a nvmem device for given nvmem_config.
874 * Also creates a binary entry in /sys/bus/nvmem/devices/dev-name/nvmem
876 * @config: nvmem device configuration with which nvmem device is created.
884 struct nvmem_device *nvmem; in nvmem_register() local
887 if (!config->dev) in nvmem_register()
888 return ERR_PTR(-EINVAL); in nvmem_register()
890 if (!config->reg_read && !config->reg_write) in nvmem_register()
891 return ERR_PTR(-EINVAL); in nvmem_register()
893 nvmem = kzalloc(sizeof(*nvmem), GFP_KERNEL); in nvmem_register()
894 if (!nvmem) in nvmem_register()
895 return ERR_PTR(-ENOMEM); in nvmem_register()
899 kfree(nvmem); in nvmem_register()
903 nvmem->id = rval; in nvmem_register()
905 nvmem->dev.type = &nvmem_provider_type; in nvmem_register()
906 nvmem->dev.bus = &nvmem_bus_type; in nvmem_register()
907 nvmem->dev.parent = config->dev; in nvmem_register()
909 device_initialize(&nvmem->dev); in nvmem_register()
911 if (!config->ignore_wp) in nvmem_register()
912 nvmem->wp_gpio = gpiod_get_optional(config->dev, "wp", in nvmem_register()
914 if (IS_ERR(nvmem->wp_gpio)) { in nvmem_register()
915 rval = PTR_ERR(nvmem->wp_gpio); in nvmem_register()
916 nvmem->wp_gpio = NULL; in nvmem_register()
920 kref_init(&nvmem->refcnt); in nvmem_register()
921 INIT_LIST_HEAD(&nvmem->cells); in nvmem_register()
923 nvmem->owner = config->owner; in nvmem_register()
924 if (!nvmem->owner && config->dev->driver) in nvmem_register()
925 nvmem->owner = config->dev->driver->owner; in nvmem_register()
926 nvmem->stride = config->stride ?: 1; in nvmem_register()
927 nvmem->word_size = config->word_size ?: 1; in nvmem_register()
928 nvmem->size = config->size; in nvmem_register()
929 nvmem->root_only = config->root_only; in nvmem_register()
930 nvmem->priv = config->priv; in nvmem_register()
931 nvmem->type = config->type; in nvmem_register()
932 nvmem->reg_read = config->reg_read; in nvmem_register()
933 nvmem->reg_write = config->reg_write; in nvmem_register()
934 nvmem->keepout = config->keepout; in nvmem_register()
935 nvmem->nkeepout = config->nkeepout; in nvmem_register()
936 if (config->of_node) in nvmem_register()
937 nvmem->dev.of_node = config->of_node; in nvmem_register()
938 else if (!config->no_of_node) in nvmem_register()
939 nvmem->dev.of_node = config->dev->of_node; in nvmem_register()
941 switch (config->id) { in nvmem_register()
943 rval = dev_set_name(&nvmem->dev, "%s", config->name); in nvmem_register()
946 rval = dev_set_name(&nvmem->dev, "%s%d", config->name, nvmem->id); in nvmem_register()
949 rval = dev_set_name(&nvmem->dev, "%s%d", in nvmem_register()
950 config->name ? : "nvmem", in nvmem_register()
951 config->name ? config->id : nvmem->id); in nvmem_register()
958 nvmem->read_only = device_property_present(config->dev, "read-only") || in nvmem_register()
959 config->read_only || !nvmem->reg_write; in nvmem_register()
962 nvmem->dev.groups = nvmem_dev_groups; in nvmem_register()
965 if (nvmem->nkeepout) { in nvmem_register()
966 rval = nvmem_validate_keepouts(nvmem); in nvmem_register()
971 if (config->compat) { in nvmem_register()
972 rval = nvmem_sysfs_setup_compat(nvmem, config); in nvmem_register()
978 * If the driver supplied a layout by config->layout, the module in nvmem_register()
981 nvmem->layout = config->layout ?: nvmem_layout_get(nvmem); in nvmem_register()
982 if (IS_ERR(nvmem->layout)) { in nvmem_register()
983 rval = PTR_ERR(nvmem->layout); in nvmem_register()
984 nvmem->layout = NULL; in nvmem_register()
986 if (rval == -EPROBE_DEFER) in nvmem_register()
990 if (config->cells) { in nvmem_register()
991 rval = nvmem_add_cells(nvmem, config->cells, config->ncells); in nvmem_register()
996 rval = nvmem_add_cells_from_table(nvmem); in nvmem_register()
1000 rval = nvmem_add_cells_from_legacy_of(nvmem); in nvmem_register()
1004 rval = nvmem_add_cells_from_fixed_layout(nvmem); in nvmem_register()
1008 rval = nvmem_add_cells_from_layout(nvmem); in nvmem_register()
1012 dev_dbg(&nvmem->dev, "Registering nvmem device %s\n", config->name); in nvmem_register()
1014 rval = device_add(&nvmem->dev); in nvmem_register()
1018 blocking_notifier_call_chain(&nvmem_notifier, NVMEM_ADD, nvmem); in nvmem_register()
1020 return nvmem; in nvmem_register()
1023 nvmem_device_remove_all_cells(nvmem); in nvmem_register()
1024 nvmem_layout_put(nvmem->layout); in nvmem_register()
1026 if (config->compat) in nvmem_register()
1027 nvmem_sysfs_remove_compat(nvmem, config); in nvmem_register()
1029 put_device(&nvmem->dev); in nvmem_register()
1037 struct nvmem_device *nvmem; in nvmem_device_release() local
1039 nvmem = container_of(kref, struct nvmem_device, refcnt); in nvmem_device_release()
1041 blocking_notifier_call_chain(&nvmem_notifier, NVMEM_REMOVE, nvmem); in nvmem_device_release()
1043 if (nvmem->flags & FLAG_COMPAT) in nvmem_device_release()
1044 device_remove_bin_file(nvmem->base_dev, &nvmem->eeprom); in nvmem_device_release()
1046 nvmem_device_remove_all_cells(nvmem); in nvmem_device_release()
1047 nvmem_layout_put(nvmem->layout); in nvmem_device_release()
1048 device_unregister(&nvmem->dev); in nvmem_device_release()
1052 * nvmem_unregister() - Unregister previously registered nvmem device
1054 * @nvmem: Pointer to previously registered nvmem device.
1056 void nvmem_unregister(struct nvmem_device *nvmem) in nvmem_unregister() argument
1058 if (nvmem) in nvmem_unregister()
1059 kref_put(&nvmem->refcnt, nvmem_device_release); in nvmem_unregister()
1063 static void devm_nvmem_unregister(void *nvmem) in devm_nvmem_unregister() argument
1065 nvmem_unregister(nvmem); in devm_nvmem_unregister()
1069 * devm_nvmem_register() - Register a managed nvmem device for given
1071 * Also creates a binary entry in /sys/bus/nvmem/devices/dev-name/nvmem
1073 * @dev: Device that uses the nvmem device.
1074 * @config: nvmem device configuration with which nvmem device is created.
1082 struct nvmem_device *nvmem; in devm_nvmem_register() local
1085 nvmem = nvmem_register(config); in devm_nvmem_register()
1086 if (IS_ERR(nvmem)) in devm_nvmem_register()
1087 return nvmem; in devm_nvmem_register()
1089 ret = devm_add_action_or_reset(dev, devm_nvmem_unregister, nvmem); in devm_nvmem_register()
1093 return nvmem; in devm_nvmem_register()
1100 struct nvmem_device *nvmem = NULL; in __nvmem_device_get() local
1106 nvmem = to_nvmem_device(dev); in __nvmem_device_get()
1108 if (!nvmem) in __nvmem_device_get()
1109 return ERR_PTR(-EPROBE_DEFER); in __nvmem_device_get()
1111 if (!try_module_get(nvmem->owner)) { in __nvmem_device_get()
1112 dev_err(&nvmem->dev, in __nvmem_device_get()
1114 nvmem_dev_name(nvmem)); in __nvmem_device_get()
1116 put_device(&nvmem->dev); in __nvmem_device_get()
1117 return ERR_PTR(-EINVAL); in __nvmem_device_get()
1120 kref_get(&nvmem->refcnt); in __nvmem_device_get()
1122 return nvmem; in __nvmem_device_get()
1125 static void __nvmem_device_put(struct nvmem_device *nvmem) in __nvmem_device_put() argument
1127 put_device(&nvmem->dev); in __nvmem_device_put()
1128 module_put(nvmem->owner); in __nvmem_device_put()
1129 kref_put(&nvmem->refcnt, nvmem_device_release); in __nvmem_device_put()
1134 * of_nvmem_device_get() - Get nvmem device from a given id
1136 * @np: Device tree node that uses the nvmem device.
1137 * @id: nvmem name from nvmem-names property.
1146 struct nvmem_device *nvmem; in of_nvmem_device_get() local
1150 index = of_property_match_string(np, "nvmem-names", id); in of_nvmem_device_get()
1152 nvmem_np = of_parse_phandle(np, "nvmem", index); in of_nvmem_device_get()
1154 return ERR_PTR(-ENOENT); in of_nvmem_device_get()
1156 nvmem = __nvmem_device_get(nvmem_np, device_match_of_node); in of_nvmem_device_get()
1158 return nvmem; in of_nvmem_device_get()
1164 * nvmem_device_get() - Get nvmem device from a given id
1166 * @dev: Device that uses the nvmem device.
1167 * @dev_name: name of the requested nvmem device.
1174 if (dev->of_node) { /* try dt first */ in nvmem_device_get()
1175 struct nvmem_device *nvmem; in nvmem_device_get() local
1177 nvmem = of_nvmem_device_get(dev->of_node, dev_name); in nvmem_device_get()
1179 if (!IS_ERR(nvmem) || PTR_ERR(nvmem) == -EPROBE_DEFER) in nvmem_device_get()
1180 return nvmem; in nvmem_device_get()
1189 * nvmem_device_find() - Find nvmem device with matching function
1206 struct nvmem_device **nvmem = res; in devm_nvmem_device_match() local
1208 if (WARN_ON(!nvmem || !*nvmem)) in devm_nvmem_device_match()
1211 return *nvmem == data; in devm_nvmem_device_match()
1220 * devm_nvmem_device_put() - put alredy got nvmem device
1222 * @dev: Device that uses the nvmem device.
1223 * @nvmem: pointer to nvmem device allocated by devm_nvmem_cell_get(),
1226 void devm_nvmem_device_put(struct device *dev, struct nvmem_device *nvmem) in devm_nvmem_device_put() argument
1231 devm_nvmem_device_match, nvmem); in devm_nvmem_device_put()
1238 * nvmem_device_put() - put alredy got nvmem device
1240 * @nvmem: pointer to nvmem device that needs to be released.
1242 void nvmem_device_put(struct nvmem_device *nvmem) in nvmem_device_put() argument
1244 __nvmem_device_put(nvmem); in nvmem_device_put()
1249 * devm_nvmem_device_get() - Get nvmem cell of device form a given id
1251 * @dev: Device that requests the nvmem device.
1252 * @id: name id for the requested nvmem device.
1260 struct nvmem_device **ptr, *nvmem; in devm_nvmem_device_get() local
1264 return ERR_PTR(-ENOMEM); in devm_nvmem_device_get()
1266 nvmem = nvmem_device_get(dev, id); in devm_nvmem_device_get()
1267 if (!IS_ERR(nvmem)) { in devm_nvmem_device_get()
1268 *ptr = nvmem; in devm_nvmem_device_get()
1274 return nvmem; in devm_nvmem_device_get()
1286 return ERR_PTR(-ENOMEM); in nvmem_create_cell()
1292 return ERR_PTR(-ENOMEM); in nvmem_create_cell()
1296 cell->id = name; in nvmem_create_cell()
1297 cell->entry = entry; in nvmem_create_cell()
1298 cell->index = index; in nvmem_create_cell()
1307 struct nvmem_cell *cell = ERR_PTR(-ENOENT); in nvmem_cell_get_from_lookup()
1309 struct nvmem_device *nvmem; in nvmem_cell_get_from_lookup() local
1313 return ERR_PTR(-EINVAL); in nvmem_cell_get_from_lookup()
1320 if ((strcmp(lookup->dev_id, dev_id) == 0) && in nvmem_cell_get_from_lookup()
1321 (strcmp(lookup->con_id, con_id) == 0)) { in nvmem_cell_get_from_lookup()
1323 nvmem = __nvmem_device_get((void *)lookup->nvmem_name, in nvmem_cell_get_from_lookup()
1325 if (IS_ERR(nvmem)) { in nvmem_cell_get_from_lookup()
1327 cell = ERR_CAST(nvmem); in nvmem_cell_get_from_lookup()
1331 cell_entry = nvmem_find_cell_entry_by_name(nvmem, in nvmem_cell_get_from_lookup()
1332 lookup->cell_name); in nvmem_cell_get_from_lookup()
1334 __nvmem_device_put(nvmem); in nvmem_cell_get_from_lookup()
1335 cell = ERR_PTR(-ENOENT); in nvmem_cell_get_from_lookup()
1339 __nvmem_device_put(nvmem); in nvmem_cell_get_from_lookup()
1351 nvmem_find_cell_entry_by_node(struct nvmem_device *nvmem, struct device_node *np) in nvmem_find_cell_entry_by_node() argument
1356 list_for_each_entry(iter, &nvmem->cells, node) { in nvmem_find_cell_entry_by_node()
1357 if (np == iter->np) { in nvmem_find_cell_entry_by_node()
1368 * of_nvmem_cell_get() - Get a nvmem cell from given device node and cell id
1370 * @np: Device tree node that uses the nvmem cell.
1371 * @id: nvmem cell name from nvmem-cell-names property, or NULL
1373 * nvmem-cell-names property).
1382 struct nvmem_device *nvmem; in of_nvmem_cell_get() local
1392 index = of_property_match_string(np, "nvmem-cell-names", id); in of_nvmem_cell_get()
1394 ret = of_parse_phandle_with_optional_args(np, "nvmem-cells", in of_nvmem_cell_get()
1395 "#nvmem-cell-cells", in of_nvmem_cell_get()
1398 return ERR_PTR(-ENOENT); in of_nvmem_cell_get()
1401 return ERR_PTR(-EINVAL); in of_nvmem_cell_get()
1410 return ERR_PTR(-EINVAL); in of_nvmem_cell_get()
1413 /* nvmem layouts produce cells within the nvmem-layout container */ in of_nvmem_cell_get()
1414 if (of_node_name_eq(nvmem_np, "nvmem-layout")) { in of_nvmem_cell_get()
1418 return ERR_PTR(-EINVAL); in of_nvmem_cell_get()
1422 nvmem = __nvmem_device_get(nvmem_np, device_match_of_node); in of_nvmem_cell_get()
1424 if (IS_ERR(nvmem)) { in of_nvmem_cell_get()
1426 return ERR_CAST(nvmem); in of_nvmem_cell_get()
1429 cell_entry = nvmem_find_cell_entry_by_node(nvmem, cell_np); in of_nvmem_cell_get()
1432 __nvmem_device_put(nvmem); in of_nvmem_cell_get()
1433 return ERR_PTR(-ENOENT); in of_nvmem_cell_get()
1438 __nvmem_device_put(nvmem); in of_nvmem_cell_get()
1446 * nvmem_cell_get() - Get nvmem cell of device form a given cell name
1448 * @dev: Device that requests the nvmem cell.
1449 * @id: nvmem cell name to get (this corresponds with the name from the
1450 * nvmem-cell-names property for DT systems and with the con_id from
1451 * the lookup entry for non-DT systems).
1461 if (dev->of_node) { /* try dt first */ in nvmem_cell_get()
1462 cell = of_nvmem_cell_get(dev->of_node, id); in nvmem_cell_get()
1463 if (!IS_ERR(cell) || PTR_ERR(cell) == -EPROBE_DEFER) in nvmem_cell_get()
1469 return ERR_PTR(-EINVAL); in nvmem_cell_get()
1481 * devm_nvmem_cell_get() - Get nvmem cell of device form a given id
1483 * @dev: Device that requests the nvmem cell.
1484 * @id: nvmem cell name id to get.
1496 return ERR_PTR(-ENOMEM); in devm_nvmem_cell_get()
1521 * devm_nvmem_cell_put() - Release previously allocated nvmem cell
1524 * @dev: Device that requests the nvmem cell.
1525 * @cell: Previously allocated nvmem cell by devm_nvmem_cell_get().
1539 * nvmem_cell_put() - Release previously allocated nvmem cell.
1541 * @cell: Previously allocated nvmem cell by nvmem_cell_get().
1545 struct nvmem_device *nvmem = cell->entry->nvmem; in nvmem_cell_put() local
1547 if (cell->id) in nvmem_cell_put()
1548 kfree_const(cell->id); in nvmem_cell_put()
1551 __nvmem_device_put(nvmem); in nvmem_cell_put()
1558 int i, extra, bit_offset = cell->bit_offset; in nvmem_shift_read_buffer_in_place()
1566 for (i = 1; i < cell->bytes; i++) { in nvmem_shift_read_buffer_in_place()
1568 *p |= *b << (BITS_PER_BYTE - bit_offset); in nvmem_shift_read_buffer_in_place()
1575 p += cell->bytes - 1; in nvmem_shift_read_buffer_in_place()
1579 extra = cell->bytes - DIV_ROUND_UP(cell->nbits, BITS_PER_BYTE); in nvmem_shift_read_buffer_in_place()
1580 while (--extra >= 0) in nvmem_shift_read_buffer_in_place()
1581 *p-- = 0; in nvmem_shift_read_buffer_in_place()
1584 if (cell->nbits % BITS_PER_BYTE) in nvmem_shift_read_buffer_in_place()
1585 *p &= GENMASK((cell->nbits % BITS_PER_BYTE) - 1, 0); in nvmem_shift_read_buffer_in_place()
1588 static int __nvmem_cell_read(struct nvmem_device *nvmem, in __nvmem_cell_read() argument
1594 rc = nvmem_reg_read(nvmem, cell->offset, buf, cell->raw_len); in __nvmem_cell_read()
1599 /* shift bits in-place */ in __nvmem_cell_read()
1600 if (cell->bit_offset || cell->nbits) in __nvmem_cell_read()
1603 if (cell->read_post_process) { in __nvmem_cell_read()
1604 rc = cell->read_post_process(cell->priv, id, index, in __nvmem_cell_read()
1605 cell->offset, buf, cell->raw_len); in __nvmem_cell_read()
1611 *len = cell->bytes; in __nvmem_cell_read()
1617 * nvmem_cell_read() - Read a given nvmem cell
1619 * @cell: nvmem cell to be read.
1628 struct nvmem_cell_entry *entry = cell->entry; in nvmem_cell_read()
1629 struct nvmem_device *nvmem = entry->nvmem; in nvmem_cell_read() local
1633 if (!nvmem) in nvmem_cell_read()
1634 return ERR_PTR(-EINVAL); in nvmem_cell_read()
1636 buf = kzalloc(max_t(size_t, entry->raw_len, entry->bytes), GFP_KERNEL); in nvmem_cell_read()
1638 return ERR_PTR(-ENOMEM); in nvmem_cell_read()
1640 rc = __nvmem_cell_read(nvmem, cell->entry, buf, len, cell->id, cell->index); in nvmem_cell_read()
1653 struct nvmem_device *nvmem = cell->nvmem; in nvmem_cell_prepare_write_buffer() local
1654 int i, rc, nbits, bit_offset = cell->bit_offset; in nvmem_cell_prepare_write_buffer()
1657 nbits = cell->nbits; in nvmem_cell_prepare_write_buffer()
1658 buf = kzalloc(cell->bytes, GFP_KERNEL); in nvmem_cell_prepare_write_buffer()
1660 return ERR_PTR(-ENOMEM); in nvmem_cell_prepare_write_buffer()
1669 /* setup the first byte with lsb bits from nvmem */ in nvmem_cell_prepare_write_buffer()
1670 rc = nvmem_reg_read(nvmem, cell->offset, &v, 1); in nvmem_cell_prepare_write_buffer()
1673 *b++ |= GENMASK(bit_offset - 1, 0) & v; in nvmem_cell_prepare_write_buffer()
1676 for (i = 1; i < cell->bytes; i++) { in nvmem_cell_prepare_write_buffer()
1678 pbits = pbyte >> (BITS_PER_BYTE - 1 - bit_offset); in nvmem_cell_prepare_write_buffer()
1688 /* setup the last byte with msb bits from nvmem */ in nvmem_cell_prepare_write_buffer()
1689 rc = nvmem_reg_read(nvmem, in nvmem_cell_prepare_write_buffer()
1690 cell->offset + cell->bytes - 1, &v, 1); in nvmem_cell_prepare_write_buffer()
1705 struct nvmem_device *nvmem = cell->nvmem; in __nvmem_cell_entry_write() local
1708 if (!nvmem || nvmem->read_only || in __nvmem_cell_entry_write()
1709 (cell->bit_offset == 0 && len != cell->bytes)) in __nvmem_cell_entry_write()
1710 return -EINVAL; in __nvmem_cell_entry_write()
1713 * Any cells which have a read_post_process hook are read-only because in __nvmem_cell_entry_write()
1717 if (cell->read_post_process) in __nvmem_cell_entry_write()
1718 return -EINVAL; in __nvmem_cell_entry_write()
1720 if (cell->bit_offset || cell->nbits) { in __nvmem_cell_entry_write()
1726 rc = nvmem_reg_write(nvmem, cell->offset, buf, cell->bytes); in __nvmem_cell_entry_write()
1729 if (cell->bit_offset || cell->nbits) in __nvmem_cell_entry_write()
1739 * nvmem_cell_write() - Write to a given nvmem cell
1741 * @cell: nvmem cell to be written.
1743 * @len: length of buffer to be written to nvmem cell.
1749 return __nvmem_cell_entry_write(cell->entry, buf, len); in nvmem_cell_write()
1773 return -EINVAL; in nvmem_cell_read_common()
1783 * nvmem_cell_read_u8() - Read a cell value as a u8
1785 * @dev: Device that requests the nvmem cell.
1786 * @cell_id: Name of nvmem cell to read.
1798 * nvmem_cell_read_u16() - Read a cell value as a u16
1800 * @dev: Device that requests the nvmem cell.
1801 * @cell_id: Name of nvmem cell to read.
1813 * nvmem_cell_read_u32() - Read a cell value as a u32
1815 * @dev: Device that requests the nvmem cell.
1816 * @cell_id: Name of nvmem cell to read.
1828 * nvmem_cell_read_u64() - Read a cell value as a u64
1830 * @dev: Device that requests the nvmem cell.
1831 * @cell_id: Name of nvmem cell to read.
1854 nbits = cell->entry->nbits; in nvmem_cell_read_variable_common()
1869 return ERR_PTR(-ERANGE); in nvmem_cell_read_variable_common()
1876 * nvmem_cell_read_variable_le_u32() - Read up to 32-bits of data as a little endian number.
1878 * @dev: Device that requests the nvmem cell.
1879 * @cell_id: Name of nvmem cell to read.
1907 * nvmem_cell_read_variable_le_u64() - Read up to 64-bits of data as a little endian number.
1909 * @dev: Device that requests the nvmem cell.
1910 * @cell_id: Name of nvmem cell to read.
1938 * nvmem_device_cell_read() - Read a given nvmem device and cell
1940 * @nvmem: nvmem device to read from.
1941 * @info: nvmem cell info to be read.
1947 ssize_t nvmem_device_cell_read(struct nvmem_device *nvmem, in nvmem_device_cell_read() argument
1954 if (!nvmem) in nvmem_device_cell_read()
1955 return -EINVAL; in nvmem_device_cell_read()
1957 rc = nvmem_cell_info_to_nvmem_cell_entry_nodup(nvmem, info, &cell); in nvmem_device_cell_read()
1961 rc = __nvmem_cell_read(nvmem, &cell, buf, &len, NULL, 0); in nvmem_device_cell_read()
1970 * nvmem_device_cell_write() - Write cell to a given nvmem device
1972 * @nvmem: nvmem device to be written to.
1973 * @info: nvmem cell info to be written.
1978 int nvmem_device_cell_write(struct nvmem_device *nvmem, in nvmem_device_cell_write() argument
1984 if (!nvmem) in nvmem_device_cell_write()
1985 return -EINVAL; in nvmem_device_cell_write()
1987 rc = nvmem_cell_info_to_nvmem_cell_entry_nodup(nvmem, info, &cell); in nvmem_device_cell_write()
1996 * nvmem_device_read() - Read from a given nvmem device
1998 * @nvmem: nvmem device to read from.
1999 * @offset: offset in nvmem device.
2006 int nvmem_device_read(struct nvmem_device *nvmem, in nvmem_device_read() argument
2012 if (!nvmem) in nvmem_device_read()
2013 return -EINVAL; in nvmem_device_read()
2015 rc = nvmem_reg_read(nvmem, offset, buf, bytes); in nvmem_device_read()
2025 * nvmem_device_write() - Write cell to a given nvmem device
2027 * @nvmem: nvmem device to be written to.
2028 * @offset: offset in nvmem device.
2034 int nvmem_device_write(struct nvmem_device *nvmem, in nvmem_device_write() argument
2040 if (!nvmem) in nvmem_device_write()
2041 return -EINVAL; in nvmem_device_write()
2043 rc = nvmem_reg_write(nvmem, offset, buf, bytes); in nvmem_device_write()
2054 * nvmem_add_cell_table() - register a table of cell info entries
2061 list_add_tail(&table->node, &nvmem_cell_tables); in nvmem_add_cell_table()
2067 * nvmem_del_cell_table() - remove a previously registered cell info table
2074 list_del(&table->node); in nvmem_del_cell_table()
2080 * nvmem_add_cell_lookups() - register a list of cell lookup entries
2097 * nvmem_del_cell_lookups() - remove a list of previously added cell lookup
2115 * nvmem_dev_name() - Get the name of a given nvmem device.
2117 * @nvmem: nvmem device.
2119 * Return: name of the nvmem device.
2121 const char *nvmem_dev_name(struct nvmem_device *nvmem) in nvmem_dev_name() argument
2123 return dev_name(&nvmem->dev); in nvmem_dev_name()
2141 MODULE_AUTHOR("Maxime Ripard <maxime.ripard@free-electrons.com");
2142 MODULE_DESCRIPTION("nvmem Driver Core");