Quelle  abx500-core.c   Sprache: C

// 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);