1217 lines · 31.5 KB · C
RawDownload
/* * Copyright(c) 2004 - 2006 Intel Corporation. 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 as published by the Free * Software Foundation; either version 2 of the License, or (at your option) * any later version. * * 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. * * You should have received a copy of the GNU General Public License along with * this program; if not, write to the Free Software Foundation, Inc., 59 * Temple Place - Suite 330, Boston, MA  02111-1307, USA. * * The full GNU General Public License is included in this distribution in the * file called COPYING. */ /* * This code implements the DMA subsystem. It provides a HW-neutral interface * for other kernel code to use asynchronous memory copy capabilities, * if present, and allows different HW DMA drivers to register as providing * this capability. * * Due to the fact we are accelerating what is already a relatively fast * operation, the code goes to great lengths to avoid additional overhead, * such as locking. * * LOCKING: * * The subsystem keeps a global list of dma_device structs it is protected by a * mutex, dma_list_mutex. * * A subsystem can get access to a channel by calling dmaengine_get() followed * by dma_find_channel(), or if it has need for an exclusive channel it can call * dma_request_channel().  Once a channel is allocated a reference is taken * against its corresponding driver to disable removal. * * Each device has a channels list, which runs unlocked but is never modified * once the device is registered, it's just setup by the driver. * * See Documentation/dmaengine.txt for more details */ #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt #include <linux/dma-mapping.h>#include <linux/init.h>#include <linux/module.h>#include <linux/mm.h>#include <linux/device.h>#include <linux/dmaengine.h>#include <linux/hardirq.h>#include <linux/spinlock.h>#include <linux/percpu.h>#include <linux/rcupdate.h>#include <linux/mutex.h>#include <linux/jiffies.h>#include <linux/rculist.h>#include <linux/idr.h>#include <linux/slab.h>#include <linux/acpi.h>#include <linux/acpi_dma.h>#include <linux/of_dma.h>#include <linux/mempool.h> static DEFINE_MUTEX(dma_list_mutex);static DEFINE_IDR(dma_idr);static LIST_HEAD(dma_device_list);static long dmaengine_ref_count; /* --- sysfs implementation --- */ /** * dev_to_dma_chan - convert a device pointer to the its sysfs container object * @dev - device node * * Must be called under dma_list_mutex */static struct dma_chan *dev_to_dma_chan(struct device *dev){	struct dma_chan_dev *chan_dev; 	chan_dev = container_of(dev, typeof(*chan_dev), device);	return chan_dev->chan;} static ssize_t memcpy_count_show(struct device *dev,				 struct device_attribute *attr, char *buf){	struct dma_chan *chan;	unsigned long count = 0;	int i;	int err; 	mutex_lock(&dma_list_mutex);	chan = dev_to_dma_chan(dev);	if (chan) {		for_each_possible_cpu(i)			count += per_cpu_ptr(chan->local, i)->memcpy_count;		err = sprintf(buf, "%lu\n", count);	} else		err = -ENODEV;	mutex_unlock(&dma_list_mutex); 	return err;}static DEVICE_ATTR_RO(memcpy_count); static ssize_t bytes_transferred_show(struct device *dev,				      struct device_attribute *attr, char *buf){	struct dma_chan *chan;	unsigned long count = 0;	int i;	int err; 	mutex_lock(&dma_list_mutex);	chan = dev_to_dma_chan(dev);	if (chan) {		for_each_possible_cpu(i)			count += per_cpu_ptr(chan->local, i)->bytes_transferred;		err = sprintf(buf, "%lu\n", count);	} else		err = -ENODEV;	mutex_unlock(&dma_list_mutex); 	return err;}static DEVICE_ATTR_RO(bytes_transferred); static ssize_t in_use_show(struct device *dev, struct device_attribute *attr,			   char *buf){	struct dma_chan *chan;	int err; 	mutex_lock(&dma_list_mutex);	chan = dev_to_dma_chan(dev);	if (chan)		err = sprintf(buf, "%d\n", chan->client_count);	else		err = -ENODEV;	mutex_unlock(&dma_list_mutex); 	return err;}static DEVICE_ATTR_RO(in_use); static struct attribute *dma_dev_attrs[] = {	&dev_attr_memcpy_count.attr,	&dev_attr_bytes_transferred.attr,	&dev_attr_in_use.attr,	NULL,};ATTRIBUTE_GROUPS(dma_dev); static void chan_dev_release(struct device *dev){	struct dma_chan_dev *chan_dev; 	chan_dev = container_of(dev, typeof(*chan_dev), device);	if (atomic_dec_and_test(chan_dev->idr_ref)) {		mutex_lock(&dma_list_mutex);		idr_remove(&dma_idr, chan_dev->dev_id);		mutex_unlock(&dma_list_mutex);		kfree(chan_dev->idr_ref);	}	kfree(chan_dev);} static struct class dma_devclass = {	.name		= "dma",	.dev_groups	= dma_dev_groups,	.dev_release	= chan_dev_release,}; /* --- client and device registration --- */ #define dma_device_satisfies_mask(device, mask) \	__dma_device_satisfies_mask((device), &(mask))static int__dma_device_satisfies_mask(struct dma_device *device,			    const dma_cap_mask_t *want){	dma_cap_mask_t has; 	bitmap_and(has.bits, want->bits, device->cap_mask.bits,		DMA_TX_TYPE_END);	return bitmap_equal(want->bits, has.bits, DMA_TX_TYPE_END);} static struct module *dma_chan_to_owner(struct dma_chan *chan){	return chan->device->dev->driver->owner;} /** * balance_ref_count - catch up the channel reference count * @chan - channel to balance ->client_count versus dmaengine_ref_count * * balance_ref_count must be called under dma_list_mutex */static void balance_ref_count(struct dma_chan *chan){	struct module *owner = dma_chan_to_owner(chan); 	while (chan->client_count < dmaengine_ref_count) {		__module_get(owner);		chan->client_count++;	}} /** * dma_chan_get - try to grab a dma channel's parent driver module * @chan - channel to grab * * Must be called under dma_list_mutex */static int dma_chan_get(struct dma_chan *chan){	int err = -ENODEV;	struct module *owner = dma_chan_to_owner(chan); 	if (chan->client_count) {		__module_get(owner);		err = 0;	} else if (try_module_get(owner))		err = 0; 	if (err == 0)		chan->client_count++; 	/* allocate upon first client reference */	if (chan->client_count == 1 && err == 0) {		int desc_cnt = chan->device->device_alloc_chan_resources(chan); 		if (desc_cnt < 0) {			err = desc_cnt;			chan->client_count = 0;			module_put(owner);		} else if (!dma_has_cap(DMA_PRIVATE, chan->device->cap_mask))			balance_ref_count(chan);	} 	return err;} /** * dma_chan_put - drop a reference to a dma channel's parent driver module * @chan - channel to release * * Must be called under dma_list_mutex */static void dma_chan_put(struct dma_chan *chan){	if (!chan->client_count)		return; /* this channel failed alloc_chan_resources */	chan->client_count--;	module_put(dma_chan_to_owner(chan));	if (chan->client_count == 0)		chan->device->device_free_chan_resources(chan);} enum dma_status dma_sync_wait(struct dma_chan *chan, dma_cookie_t cookie){	enum dma_status status;	unsigned long dma_sync_wait_timeout = jiffies + msecs_to_jiffies(5000); 	dma_async_issue_pending(chan);	do {		status = dma_async_is_tx_complete(chan, cookie, NULL, NULL);		if (time_after_eq(jiffies, dma_sync_wait_timeout)) {			pr_err("%s: timeout!\n", __func__);			return DMA_ERROR;		}		if (status != DMA_IN_PROGRESS)			break;		cpu_relax();	} while (1); 	return status;}EXPORT_SYMBOL(dma_sync_wait); /** * dma_cap_mask_all - enable iteration over all operation types */static dma_cap_mask_t dma_cap_mask_all; /** * dma_chan_tbl_ent - tracks channel allocations per core/operation * @chan - associated channel for this entry */struct dma_chan_tbl_ent {	struct dma_chan *chan;}; /** * channel_table - percpu lookup table for memory-to-memory offload providers */static struct dma_chan_tbl_ent __percpu *channel_table[DMA_TX_TYPE_END]; static int __init dma_channel_table_init(void){	enum dma_transaction_type cap;	int err = 0; 	bitmap_fill(dma_cap_mask_all.bits, DMA_TX_TYPE_END); 	/* 'interrupt', 'private', and 'slave' are channel capabilities,	 * but are not associated with an operation so they do not need	 * an entry in the channel_table	 */	clear_bit(DMA_INTERRUPT, dma_cap_mask_all.bits);	clear_bit(DMA_PRIVATE, dma_cap_mask_all.bits);	clear_bit(DMA_SLAVE, dma_cap_mask_all.bits); 	for_each_dma_cap_mask(cap, dma_cap_mask_all) {		channel_table[cap] = alloc_percpu(struct dma_chan_tbl_ent);		if (!channel_table[cap]) {			err = -ENOMEM;			break;		}	} 	if (err) {		pr_err("initialization failure\n");		for_each_dma_cap_mask(cap, dma_cap_mask_all)			if (channel_table[cap])				free_percpu(channel_table[cap]);	} 	return err;}arch_initcall(dma_channel_table_init); /** * dma_find_channel - find a channel to carry out the operation * @tx_type: transaction type */struct dma_chan *dma_find_channel(enum dma_transaction_type tx_type){	return this_cpu_read(channel_table[tx_type]->chan);}EXPORT_SYMBOL(dma_find_channel); /* * net_dma_find_channel - find a channel for net_dma * net_dma has alignment requirements */struct dma_chan *net_dma_find_channel(void){	struct dma_chan *chan = dma_find_channel(DMA_MEMCPY);	if (chan && !is_dma_copy_aligned(chan->device, 1, 1, 1))		return NULL; 	return chan;}EXPORT_SYMBOL(net_dma_find_channel); /** * dma_issue_pending_all - flush all pending operations across all channels */void dma_issue_pending_all(void){	struct dma_device *device;	struct dma_chan *chan; 	rcu_read_lock();	list_for_each_entry_rcu(device, &dma_device_list, global_node) {		if (dma_has_cap(DMA_PRIVATE, device->cap_mask))			continue;		list_for_each_entry(chan, &device->channels, device_node)			if (chan->client_count)				device->device_issue_pending(chan);	}	rcu_read_unlock();}EXPORT_SYMBOL(dma_issue_pending_all); /** * dma_chan_is_local - returns true if the channel is in the same numa-node as the cpu */static bool dma_chan_is_local(struct dma_chan *chan, int cpu){	int node = dev_to_node(chan->device->dev);	return node == -1 || cpumask_test_cpu(cpu, cpumask_of_node(node));} /** * min_chan - returns the channel with min count and in the same numa-node as the cpu * @cap: capability to match * @cpu: cpu index which the channel should be close to * * If some channels are close to the given cpu, the one with the lowest * reference count is returned. Otherwise, cpu is ignored and only the * reference count is taken into account. * Must be called under dma_list_mutex. */static struct dma_chan *min_chan(enum dma_transaction_type cap, int cpu){	struct dma_device *device;	struct dma_chan *chan;	struct dma_chan *min = NULL;	struct dma_chan *localmin = NULL; 	list_for_each_entry(device, &dma_device_list, global_node) {		if (!dma_has_cap(cap, device->cap_mask) ||		    dma_has_cap(DMA_PRIVATE, device->cap_mask))			continue;		list_for_each_entry(chan, &device->channels, device_node) {			if (!chan->client_count)				continue;			if (!min || chan->table_count < min->table_count)				min = chan; 			if (dma_chan_is_local(chan, cpu))				if (!localmin ||				    chan->table_count < localmin->table_count)					localmin = chan;		}	} 	chan = localmin ? localmin : min; 	if (chan)		chan->table_count++; 	return chan;} /** * dma_channel_rebalance - redistribute the available channels * * Optimize for cpu isolation (each cpu gets a dedicated channel for an * operation type) in the SMP case,  and operation isolation (avoid * multi-tasking channels) in the non-SMP case.  Must be called under * dma_list_mutex. */static void dma_channel_rebalance(void){	struct dma_chan *chan;	struct dma_device *device;	int cpu;	int cap; 	/* undo the last distribution */	for_each_dma_cap_mask(cap, dma_cap_mask_all)		for_each_possible_cpu(cpu)			per_cpu_ptr(channel_table[cap], cpu)->chan = NULL; 	list_for_each_entry(device, &dma_device_list, global_node) {		if (dma_has_cap(DMA_PRIVATE, device->cap_mask))			continue;		list_for_each_entry(chan, &device->channels, device_node)			chan->table_count = 0;	} 	/* don't populate the channel_table if no clients are available */	if (!dmaengine_ref_count)		return; 	/* redistribute available channels */	for_each_dma_cap_mask(cap, dma_cap_mask_all)		for_each_online_cpu(cpu) {			chan = min_chan(cap, cpu);			per_cpu_ptr(channel_table[cap], cpu)->chan = chan;		}} static struct dma_chan *private_candidate(const dma_cap_mask_t *mask,					  struct dma_device *dev,					  dma_filter_fn fn, void *fn_param){	struct dma_chan *chan; 	if (!__dma_device_satisfies_mask(dev, mask)) {		pr_debug("%s: wrong capabilities\n", __func__);		return NULL;	}	/* devices with multiple channels need special handling as we need to	 * ensure that all channels are either private or public.	 */	if (dev->chancnt > 1 && !dma_has_cap(DMA_PRIVATE, dev->cap_mask))		list_for_each_entry(chan, &dev->channels, device_node) {			/* some channels are already publicly allocated */			if (chan->client_count)				return NULL;		} 	list_for_each_entry(chan, &dev->channels, device_node) {		if (chan->client_count) {			pr_debug("%s: %s busy\n",				 __func__, dma_chan_name(chan));			continue;		}

Lines 1–500 of 1217.