#define DEFAULT_SYMBOL_NAMESPACE "SPI_OFFLOAD"
#include <linux/cleanup.h>
#include <linux/device.h>
#include <linux/dmaengine.h>
#include <linux/export.h>
#include <linux/kref.h>
#include <linux/list.h>
#include <linux/mutex.h>
#include <linux/of.h>
#include <linux/property.h>
#include <linux/spi/offload/consumer.h>
#include <linux/spi/offload/provider.h>
#include <linux/spi/offload/types.h>
#include <linux/spi/spi.h>
#include <linux/types.h>
struct spi_controller_and_offload {
struct spi_controller *controller;
struct spi_offload *offload;
};
struct spi_offload_trigger {
struct list_head list;
struct kref ref;
struct fwnode_handle *fwnode;
struct mutex lock;
const struct spi_offload_trigger_ops *ops;
void *priv;
};
static LIST_HEAD(spi_offload_triggers);
static DEFINE_MUTEX(spi_offload_triggers_lock);
struct spi_offload *devm_spi_offload_alloc(struct device *dev,
size_t priv_size)
{
struct spi_offload *offload;
void *priv;
offload = devm_kzalloc(dev, sizeof(*offload), GFP_KERNEL);
if (!offload)
return ERR_PTR(-ENOMEM);
priv = devm_kzalloc(dev, priv_size, GFP_KERNEL);
if (!priv)
return ERR_PTR(-ENOMEM);
offload->provider_dev = dev;
offload->priv = priv;
return offload;
}
EXPORT_SYMBOL_GPL(devm_spi_offload_alloc);
static void spi_offload_put(void *data)
{
struct spi_controller_and_offload *resource = data;
resource->controller->put_offload(resource->offload);
kfree(resource);
}
struct spi_offload *devm_spi_offload_get(struct device *dev,
struct spi_device *spi,
const struct spi_offload_config *config)
{
struct spi_controller_and_offload *resource;
struct spi_offload *offload;
int ret;
if (!spi || !config)
return ERR_PTR(-EINVAL);
if (!spi->controller->get_offload)
return ERR_PTR(-ENODEV);
resource = kzalloc_obj(*resource);
if (!resource)
return ERR_PTR(-ENOMEM);
offload = spi->controller->get_offload(spi, config);
if (IS_ERR(offload)) {
kfree(resource);
return offload;
}
resource->controller = spi->controller;
resource->offload = offload;
ret = devm_add_action_or_reset(dev, spi_offload_put, resource);
if (ret)
return ERR_PTR(ret);
return offload;
}
EXPORT_SYMBOL_GPL(devm_spi_offload_get);
static void spi_offload_trigger_free(struct kref *ref)
{
struct spi_offload_trigger *trigger =
container_of(ref, struct spi_offload_trigger, ref);
mutex_destroy(&trigger->lock);
fwnode_handle_put(trigger->fwnode);
kfree(trigger);
}
static void spi_offload_trigger_put(void *data)
{
struct spi_offload_trigger *trigger = data;
scoped_guard(mutex, &trigger->lock)
if (trigger->ops && trigger->ops->release)
trigger->ops->release(trigger);
kref_put(&trigger->ref, spi_offload_trigger_free);
}
static struct spi_offload_trigger
*spi_offload_trigger_get(enum spi_offload_trigger_type type,
struct fwnode_reference_args *args)
{
struct spi_offload_trigger *trigger;
bool match = false;
int ret;
guard(mutex)(&spi_offload_triggers_lock);
list_for_each_entry(trigger, &spi_offload_triggers, list) {
if (trigger->fwnode != args->fwnode)
continue;
match = trigger->ops->match(trigger, type, args->args, args->nargs);
if (match)
break;
}
if (!match)
return ERR_PTR(-EPROBE_DEFER);
guard(mutex)(&trigger->lock);
if (trigger->ops->request) {
ret = trigger->ops->request(trigger, type, args->args, args->nargs);
if (ret)
return ERR_PTR(ret);
}
kref_get(&trigger->ref);
return trigger;
}
struct spi_offload_trigger
*devm_spi_offload_trigger_get(struct device *dev,
struct spi_offload *offload,
enum spi_offload_trigger_type type)
{
struct spi_offload_trigger *trigger;
struct fwnode_reference_args args;
int ret;
ret = fwnode_property_get_reference_args(dev_fwnode(offload->provider_dev),
"trigger-sources",
"#trigger-source-cells", 0, 0,
&args);
if (ret)
return ERR_PTR(ret);
trigger = spi_offload_trigger_get(type, &args);
fwnode_handle_put(args.fwnode);
if (IS_ERR(trigger))
return trigger;
ret = devm_add_action_or_reset(dev, spi_offload_trigger_put, trigger);
if (ret)
return ERR_PTR(ret);
return trigger;
}
EXPORT_SYMBOL_GPL(devm_spi_offload_trigger_get);
int spi_offload_trigger_validate(struct spi_offload_trigger *trigger,
struct spi_offload_trigger_config *config)
{
guard(mutex)(&trigger->lock);
if (!trigger->ops)
return -ENODEV;
if (!trigger->ops->validate)
return -EOPNOTSUPP;
return trigger->ops->validate(trigger, config);
}
EXPORT_SYMBOL_GPL(spi_offload_trigger_validate);
int spi_offload_trigger_enable(struct spi_offload *offload,
struct spi_offload_trigger *trigger,
struct spi_offload_trigger_config *config)
{
int ret;
guard(mutex)(&trigger->lock);
if (!trigger->ops)
return -ENODEV;
if (offload->ops && offload->ops->trigger_enable) {
ret = offload->ops->trigger_enable(offload);
if (ret)
return ret;
}
if (trigger->ops->enable) {
ret = trigger->ops->enable(trigger, config);
if (ret) {
if (offload->ops && offload->ops->trigger_disable)
offload->ops->trigger_disable(offload);
return ret;
}
}
return 0;
}
EXPORT_SYMBOL_GPL(spi_offload_trigger_enable);
void spi_offload_trigger_disable(struct spi_offload *offload,
struct spi_offload_trigger *trigger)
{
if (offload->ops && offload->ops->trigger_disable)
offload->ops->trigger_disable(offload);
guard(mutex)(&trigger->lock);
if (!trigger->ops)
return;
if (trigger->ops->disable)
trigger->ops->disable(trigger);
}
EXPORT_SYMBOL_GPL(spi_offload_trigger_disable);
static void spi_offload_release_dma_chan(void *chan)
{
dma_release_channel(chan);
}
struct dma_chan
*devm_spi_offload_tx_stream_request_dma_chan(struct device *dev,
struct spi_offload *offload)
{
struct dma_chan *chan;
int ret;
if (!offload->ops || !offload->ops->tx_stream_request_dma_chan)
return ERR_PTR(-EOPNOTSUPP);
chan = offload->ops->tx_stream_request_dma_chan(offload);
if (IS_ERR(chan))
return chan;
ret = devm_add_action_or_reset(dev, spi_offload_release_dma_chan, chan);
if (ret)
return ERR_PTR(ret);
return chan;
}
EXPORT_SYMBOL_GPL(devm_spi_offload_tx_stream_request_dma_chan);
struct dma_chan
*devm_spi_offload_rx_stream_request_dma_chan(struct device *dev,
struct spi_offload *offload)
{
struct dma_chan *chan;
int ret;
if (!offload->ops || !offload->ops->rx_stream_request_dma_chan)
return ERR_PTR(-EOPNOTSUPP);
chan = offload->ops->rx_stream_request_dma_chan(offload);
if (IS_ERR(chan))
return chan;
ret = devm_add_action_or_reset(dev, spi_offload_release_dma_chan, chan);
if (ret)
return ERR_PTR(ret);
return chan;
}
EXPORT_SYMBOL_GPL(devm_spi_offload_rx_stream_request_dma_chan);
static void spi_offload_trigger_unregister(void *data)
{
struct spi_offload_trigger *trigger = data;
scoped_guard(mutex, &spi_offload_triggers_lock)
list_del(&trigger->list);
scoped_guard(mutex, &trigger->lock) {
trigger->priv = NULL;
trigger->ops = NULL;
}
kref_put(&trigger->ref, spi_offload_trigger_free);
}
int devm_spi_offload_trigger_register(struct device *dev,
struct spi_offload_trigger_info *info)
{
struct spi_offload_trigger *trigger;
if (!info->fwnode || !info->ops || !info->ops->match)
return -EINVAL;
trigger = kzalloc(sizeof(*trigger), GFP_KERNEL);
if (!trigger)
return -ENOMEM;
kref_init(&trigger->ref);
mutex_init(&trigger->lock);
trigger->fwnode = fwnode_handle_get(info->fwnode);
trigger->ops = info->ops;
trigger->priv = info->priv;
scoped_guard(mutex, &spi_offload_triggers_lock)
list_add_tail(&trigger->list, &spi_offload_triggers);
return devm_add_action_or_reset(dev, spi_offload_trigger_unregister, trigger);
}
EXPORT_SYMBOL_GPL(devm_spi_offload_trigger_register);
void *spi_offload_trigger_get_priv(struct spi_offload_trigger *trigger)
{
return trigger->priv;
}
EXPORT_SYMBOL_GPL(spi_offload_trigger_get_priv);