// SPDX-License-Identifier: GPL-2.0-only /* * Copyright (C) 2007-2010 ST-Ericsson * Register access functions for the ABX500 Mixed Signal IC family. * Author: Mattias Wallin <mattias.wallin@stericsson.com> */ #include <linux/list.h> #include <linux/slab.h> #include <linux/err.h> #include <linux/init.h> #include <linux/export.h> #include <linux/mfd/abx500.h> static LIST_HEAD(abx500_list); struct abx500_device_entry { struct list_head list; struct abx500_ops ops; struct device *dev; }; static void lookup_ops(struct device *dev, struct abx500_ops **ops) { struct abx500_device_entry *dev_entry; *ops = NULL; list_for_each_entry(dev_entry, &abx500_list, list) { if (dev_entry->dev == dev) { *ops = &dev_entry->ops; return; } } } int abx500_register_ops(struct device *dev, struct abx500_ops *ops) { struct abx500_device_entry *dev_entry; dev_entry = devm_kzalloc(dev, sizeof(*dev_entry), GFP_KERNEL); if (!dev_entry) return -ENOMEM; dev_entry->dev = dev; memcpy(&dev_entry->ops, ops, sizeof(*ops)); list_add_tail(&dev_entry->list, &abx500_list); return 0; } EXPORT_SYMBOL(abx500_register_ops); void abx500_remove_ops(struct device *dev) { struct abx500_device_entry *dev_entry, *tmp; list_for_each_entry_safe(dev_entry, tmp, &abx500_list, list) if (dev_entry->dev == dev) list_del(&dev_entry->list); } EXPORT_SYMBOL(abx500_remove_ops); int abx500_set_register_interruptible(struct device *dev, u8 bank, u8 reg, u8 value) { struct abx500_ops *ops; lookup_ops(dev->parent, &ops); if (ops && ops->set_register) return ops->set_register(dev, bank, reg, value); else return -ENOTSUPP; } EXPORT_SYMBOL(abx500_set_register_interruptible); int abx500_get_register_interruptible(struct device *dev, u8 bank, u8 reg, u8 *value) { struct abx500_ops *ops; lookup_ops(dev->parent, &ops); if (ops && ops->get_register) return ops->get_register(dev, bank, reg, value); else return -ENOTSUPP; } EXPORT_SYMBOL(abx500_get_register_interruptible); int abx500_get_register_page_interruptible(struct device *dev, u8 bank, u8 first_reg, u8 *regvals, u8 numregs) { struct abx500_ops *ops; lookup_ops(dev->parent, &ops); if (ops && ops->get_register_page) return ops->get_register_page(dev, bank, first_reg, regvals, numregs); else return -ENOTSUPP; } EXPORT_SYMBOL(abx500_get_register_page_interruptible); int abx500_mask_and_set_register_interruptible(struct device *dev, u8 bank, u8 reg, u8 bitmask, u8 bitvalues) { struct abx500_ops *ops; lookup_ops(dev->parent, &ops); if (ops && ops->mask_and_set_register) return ops->mask_and_set_register(dev, bank, reg, bitmask, bitvalues); else return -ENOTSUPP; } EXPORT_SYMBOL(abx500_mask_and_set_register_interruptible); int abx500_get_chip_id(struct device *dev) { struct abx500_ops *ops; lookup_ops(dev->parent, &ops); if (ops && ops->get_chip_id) return ops->get_chip_id(dev); else return -ENOTSUPP; } EXPORT_SYMBOL(abx500_get_chip_id); int abx500_event_registers_startup_state_get(struct device *dev, u8 *event) { struct abx500_ops *ops; lookup_ops(dev->parent, &ops); if (ops && ops->event_registers_startup_state_get) return ops->event_registers_startup_state_get(dev, event); else return -ENOTSUPP; } EXPORT_SYMBOL(abx500_event_registers_startup_state_get); int abx500_startup_irq_enabled(struct device *dev, unsigned int irq) { struct abx500_ops *ops; lookup_ops(dev->parent, &ops); if (ops && ops->startup_irq_enabled) return ops->startup_irq_enabled(dev, irq); else return -ENOTSUPP; } EXPORT_SYMBOL(abx500_startup_irq_enabled);