linux-imx

/*

 * Copyright (C) 2007-2010 ST-Ericsson

 * License terms: GNU General Public License (GPL) version 2

 * 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)