diff options
Diffstat (limited to 'drivers/esoc/esoc_client.c')
| -rw-r--r-- | drivers/esoc/esoc_client.c | 131 |
1 files changed, 131 insertions, 0 deletions
diff --git a/drivers/esoc/esoc_client.c b/drivers/esoc/esoc_client.c new file mode 100644 index 000000000000..6dee2f37b46d --- /dev/null +++ b/drivers/esoc/esoc_client.c @@ -0,0 +1,131 @@ +/* Copyright (c) 2014, The Linux Foundation. All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 and + * only version 2 as published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ + +#include <linux/esoc_client.h> +#include <linux/of.h> +#include <linux/spinlock.h> +#include "esoc.h" + +static DEFINE_SPINLOCK(notify_lock); +static ATOMIC_NOTIFIER_HEAD(client_notify); + +static void devm_esoc_desc_release(struct device *dev, void *res) +{ + struct esoc_desc *esoc_desc = res; + kfree(esoc_desc->name); + kfree(esoc_desc->link); + put_esoc_clink(esoc_desc->priv); +} + +static int devm_esoc_desc_match(struct device *dev, void *res, void *data) +{ + struct esoc_desc *esoc_desc = res; + return esoc_desc == data; +} + +struct esoc_desc *devm_register_esoc_client(struct device *dev, + const char *name) +{ + int ret, index; + const char *client_desc; + char *esoc_prop; + const __be32 *parp; + struct device_node *esoc_node; + struct device_node *np = dev->of_node; + struct esoc_clink *esoc_clink; + struct esoc_desc *desc; + char *esoc_name, *esoc_link; + + for (index = 0;; index++) { + esoc_prop = kasprintf(GFP_KERNEL, "esoc-%d", index); + parp = of_get_property(np, esoc_prop, NULL); + if (parp == NULL) { + dev_err(dev, "esoc device not present\n"); + kfree(esoc_prop); + return NULL; + } + ret = of_property_read_string_index(np, "esoc-names", index, + &client_desc); + if (ret) { + dev_err(dev, "cannot find matching string\n"); + kfree(esoc_prop); + return NULL; + } + if (strcmp(client_desc, name)) { + kfree(esoc_prop); + continue; + } + kfree(esoc_prop); + esoc_node = of_find_node_by_phandle(be32_to_cpup(parp)); + esoc_clink = get_esoc_clink_by_node(esoc_node); + if (IS_ERR_OR_NULL(esoc_clink)) { + dev_err(dev, "matching esoc clink not present\n"); + return ERR_PTR(-EPROBE_DEFER); + } + esoc_name = kasprintf(GFP_KERNEL, "esoc%d", + esoc_clink->id); + if (IS_ERR_OR_NULL(esoc_name)) { + dev_err(dev, "unable to allocate esoc name\n"); + return ERR_PTR(-ENOMEM); + } + esoc_link = kasprintf(GFP_KERNEL, "%s", esoc_clink->link_name); + if (IS_ERR_OR_NULL(esoc_link)) { + dev_err(dev, "unable to allocate esoc link name\n"); + kfree(esoc_name); + return ERR_PTR(-ENOMEM); + } + desc = devres_alloc(devm_esoc_desc_release, + sizeof(*desc), GFP_KERNEL); + if (IS_ERR_OR_NULL(desc)) { + kfree(esoc_name); + kfree(esoc_link); + dev_err(dev, "unable to allocate esoc descriptor\n"); + return ERR_PTR(-ENOMEM); + } + desc->name = esoc_name; + desc->link = esoc_link; + desc->priv = esoc_clink; + devres_add(dev, desc); + return desc; + } + return NULL; +} +EXPORT_SYMBOL(devm_register_esoc_client); + +void devm_unregister_esoc_client(struct device *dev, + struct esoc_desc *esoc_desc) +{ + int ret; + + ret = devres_release(dev, devm_esoc_desc_release, + devm_esoc_desc_match, esoc_desc); + WARN_ON(ret); +} +EXPORT_SYMBOL(devm_unregister_esoc_client); + +int esoc_register_client_notifier(struct notifier_block *nb) +{ + return atomic_notifier_chain_register(&client_notify, nb); +} +EXPORT_SYMBOL(esoc_register_client_notifier); + +void notify_esoc_clients(struct esoc_clink *esoc_clink, unsigned long evt) +{ + unsigned int id; + unsigned long flags; + + spin_lock_irqsave(¬ify_lock, flags); + id = esoc_clink->id; + atomic_notifier_call_chain(&client_notify, evt, &id); + spin_unlock_irqrestore(¬ify_lock, flags); +} +EXPORT_SYMBOL(notify_esoc_clients); |