Commit | Line | Data |
---|---|---|
c13c8260 CL |
1 | /* |
2 | * Copyright(c) 2004 - 2006 Intel Corporation. All rights reserved. | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify it | |
5 | * under the terms of the GNU General Public License as published by the Free | |
6 | * Software Foundation; either version 2 of the License, or (at your option) | |
7 | * any later version. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
10 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
11 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
12 | * more details. | |
13 | * | |
c13c8260 CL |
14 | * The full GNU General Public License is included in this distribution in the |
15 | * file called COPYING. | |
16 | */ | |
17 | ||
18 | /* | |
19 | * This code implements the DMA subsystem. It provides a HW-neutral interface | |
20 | * for other kernel code to use asynchronous memory copy capabilities, | |
21 | * if present, and allows different HW DMA drivers to register as providing | |
22 | * this capability. | |
23 | * | |
24 | * Due to the fact we are accelerating what is already a relatively fast | |
25 | * operation, the code goes to great lengths to avoid additional overhead, | |
26 | * such as locking. | |
27 | * | |
28 | * LOCKING: | |
29 | * | |
aa1e6f1a DW |
30 | * The subsystem keeps a global list of dma_device structs it is protected by a |
31 | * mutex, dma_list_mutex. | |
c13c8260 | 32 | * |
f27c580c DW |
33 | * A subsystem can get access to a channel by calling dmaengine_get() followed |
34 | * by dma_find_channel(), or if it has need for an exclusive channel it can call | |
35 | * dma_request_channel(). Once a channel is allocated a reference is taken | |
36 | * against its corresponding driver to disable removal. | |
37 | * | |
c13c8260 CL |
38 | * Each device has a channels list, which runs unlocked but is never modified |
39 | * once the device is registered, it's just setup by the driver. | |
40 | * | |
f27c580c | 41 | * See Documentation/dmaengine.txt for more details |
c13c8260 CL |
42 | */ |
43 | ||
63433250 JP |
44 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
45 | ||
a8135d0d | 46 | #include <linux/platform_device.h> |
b7f080cf | 47 | #include <linux/dma-mapping.h> |
c13c8260 CL |
48 | #include <linux/init.h> |
49 | #include <linux/module.h> | |
7405f74b | 50 | #include <linux/mm.h> |
c13c8260 CL |
51 | #include <linux/device.h> |
52 | #include <linux/dmaengine.h> | |
53 | #include <linux/hardirq.h> | |
54 | #include <linux/spinlock.h> | |
55 | #include <linux/percpu.h> | |
56 | #include <linux/rcupdate.h> | |
57 | #include <linux/mutex.h> | |
7405f74b | 58 | #include <linux/jiffies.h> |
2ba05622 | 59 | #include <linux/rculist.h> |
864498aa | 60 | #include <linux/idr.h> |
5a0e3ad6 | 61 | #include <linux/slab.h> |
4e82f5dd AS |
62 | #include <linux/acpi.h> |
63 | #include <linux/acpi_dma.h> | |
9a6cecc8 | 64 | #include <linux/of_dma.h> |
45c463ae | 65 | #include <linux/mempool.h> |
c13c8260 CL |
66 | |
67 | static DEFINE_MUTEX(dma_list_mutex); | |
21ef4b8b | 68 | static DEFINE_IDR(dma_idr); |
c13c8260 | 69 | static LIST_HEAD(dma_device_list); |
6f49a57a | 70 | static long dmaengine_ref_count; |
c13c8260 CL |
71 | |
72 | /* --- sysfs implementation --- */ | |
73 | ||
41d5e59c DW |
74 | /** |
75 | * dev_to_dma_chan - convert a device pointer to the its sysfs container object | |
76 | * @dev - device node | |
77 | * | |
78 | * Must be called under dma_list_mutex | |
79 | */ | |
80 | static struct dma_chan *dev_to_dma_chan(struct device *dev) | |
81 | { | |
82 | struct dma_chan_dev *chan_dev; | |
83 | ||
84 | chan_dev = container_of(dev, typeof(*chan_dev), device); | |
85 | return chan_dev->chan; | |
86 | } | |
87 | ||
58b267d3 GKH |
88 | static ssize_t memcpy_count_show(struct device *dev, |
89 | struct device_attribute *attr, char *buf) | |
c13c8260 | 90 | { |
41d5e59c | 91 | struct dma_chan *chan; |
c13c8260 CL |
92 | unsigned long count = 0; |
93 | int i; | |
41d5e59c | 94 | int err; |
c13c8260 | 95 | |
41d5e59c DW |
96 | mutex_lock(&dma_list_mutex); |
97 | chan = dev_to_dma_chan(dev); | |
98 | if (chan) { | |
99 | for_each_possible_cpu(i) | |
100 | count += per_cpu_ptr(chan->local, i)->memcpy_count; | |
101 | err = sprintf(buf, "%lu\n", count); | |
102 | } else | |
103 | err = -ENODEV; | |
104 | mutex_unlock(&dma_list_mutex); | |
c13c8260 | 105 | |
41d5e59c | 106 | return err; |
c13c8260 | 107 | } |
58b267d3 | 108 | static DEVICE_ATTR_RO(memcpy_count); |
c13c8260 | 109 | |
58b267d3 GKH |
110 | static ssize_t bytes_transferred_show(struct device *dev, |
111 | struct device_attribute *attr, char *buf) | |
c13c8260 | 112 | { |
41d5e59c | 113 | struct dma_chan *chan; |
c13c8260 CL |
114 | unsigned long count = 0; |
115 | int i; | |
41d5e59c | 116 | int err; |
c13c8260 | 117 | |
41d5e59c DW |
118 | mutex_lock(&dma_list_mutex); |
119 | chan = dev_to_dma_chan(dev); | |
120 | if (chan) { | |
121 | for_each_possible_cpu(i) | |
122 | count += per_cpu_ptr(chan->local, i)->bytes_transferred; | |
123 | err = sprintf(buf, "%lu\n", count); | |
124 | } else | |
125 | err = -ENODEV; | |
126 | mutex_unlock(&dma_list_mutex); | |
c13c8260 | 127 | |
41d5e59c | 128 | return err; |
c13c8260 | 129 | } |
58b267d3 | 130 | static DEVICE_ATTR_RO(bytes_transferred); |
c13c8260 | 131 | |
58b267d3 GKH |
132 | static ssize_t in_use_show(struct device *dev, struct device_attribute *attr, |
133 | char *buf) | |
c13c8260 | 134 | { |
41d5e59c DW |
135 | struct dma_chan *chan; |
136 | int err; | |
c13c8260 | 137 | |
41d5e59c DW |
138 | mutex_lock(&dma_list_mutex); |
139 | chan = dev_to_dma_chan(dev); | |
140 | if (chan) | |
141 | err = sprintf(buf, "%d\n", chan->client_count); | |
142 | else | |
143 | err = -ENODEV; | |
144 | mutex_unlock(&dma_list_mutex); | |
145 | ||
146 | return err; | |
c13c8260 | 147 | } |
58b267d3 | 148 | static DEVICE_ATTR_RO(in_use); |
c13c8260 | 149 | |
58b267d3 GKH |
150 | static struct attribute *dma_dev_attrs[] = { |
151 | &dev_attr_memcpy_count.attr, | |
152 | &dev_attr_bytes_transferred.attr, | |
153 | &dev_attr_in_use.attr, | |
154 | NULL, | |
c13c8260 | 155 | }; |
58b267d3 | 156 | ATTRIBUTE_GROUPS(dma_dev); |
c13c8260 | 157 | |
41d5e59c DW |
158 | static void chan_dev_release(struct device *dev) |
159 | { | |
160 | struct dma_chan_dev *chan_dev; | |
161 | ||
162 | chan_dev = container_of(dev, typeof(*chan_dev), device); | |
864498aa DW |
163 | if (atomic_dec_and_test(chan_dev->idr_ref)) { |
164 | mutex_lock(&dma_list_mutex); | |
165 | idr_remove(&dma_idr, chan_dev->dev_id); | |
166 | mutex_unlock(&dma_list_mutex); | |
167 | kfree(chan_dev->idr_ref); | |
168 | } | |
41d5e59c DW |
169 | kfree(chan_dev); |
170 | } | |
171 | ||
c13c8260 | 172 | static struct class dma_devclass = { |
891f78ea | 173 | .name = "dma", |
58b267d3 | 174 | .dev_groups = dma_dev_groups, |
41d5e59c | 175 | .dev_release = chan_dev_release, |
c13c8260 CL |
176 | }; |
177 | ||
178 | /* --- client and device registration --- */ | |
179 | ||
59b5ec21 DW |
180 | #define dma_device_satisfies_mask(device, mask) \ |
181 | __dma_device_satisfies_mask((device), &(mask)) | |
d379b01e | 182 | static int |
a53e28da LPC |
183 | __dma_device_satisfies_mask(struct dma_device *device, |
184 | const dma_cap_mask_t *want) | |
d379b01e DW |
185 | { |
186 | dma_cap_mask_t has; | |
187 | ||
59b5ec21 | 188 | bitmap_and(has.bits, want->bits, device->cap_mask.bits, |
d379b01e DW |
189 | DMA_TX_TYPE_END); |
190 | return bitmap_equal(want->bits, has.bits, DMA_TX_TYPE_END); | |
191 | } | |
192 | ||
6f49a57a DW |
193 | static struct module *dma_chan_to_owner(struct dma_chan *chan) |
194 | { | |
195 | return chan->device->dev->driver->owner; | |
196 | } | |
197 | ||
198 | /** | |
199 | * balance_ref_count - catch up the channel reference count | |
200 | * @chan - channel to balance ->client_count versus dmaengine_ref_count | |
201 | * | |
202 | * balance_ref_count must be called under dma_list_mutex | |
203 | */ | |
204 | static void balance_ref_count(struct dma_chan *chan) | |
205 | { | |
206 | struct module *owner = dma_chan_to_owner(chan); | |
207 | ||
208 | while (chan->client_count < dmaengine_ref_count) { | |
209 | __module_get(owner); | |
210 | chan->client_count++; | |
211 | } | |
212 | } | |
213 | ||
214 | /** | |
215 | * dma_chan_get - try to grab a dma channel's parent driver module | |
216 | * @chan - channel to grab | |
217 | * | |
218 | * Must be called under dma_list_mutex | |
219 | */ | |
220 | static int dma_chan_get(struct dma_chan *chan) | |
221 | { | |
6f49a57a | 222 | struct module *owner = dma_chan_to_owner(chan); |
d2f4f99d | 223 | int ret; |
6f49a57a | 224 | |
d2f4f99d | 225 | /* The channel is already in use, update client count */ |
6f49a57a DW |
226 | if (chan->client_count) { |
227 | __module_get(owner); | |
d2f4f99d MR |
228 | goto out; |
229 | } | |
6f49a57a | 230 | |
d2f4f99d MR |
231 | if (!try_module_get(owner)) |
232 | return -ENODEV; | |
6f49a57a DW |
233 | |
234 | /* allocate upon first client reference */ | |
c4b54a64 MR |
235 | if (chan->device->device_alloc_chan_resources) { |
236 | ret = chan->device->device_alloc_chan_resources(chan); | |
237 | if (ret < 0) | |
238 | goto err_out; | |
239 | } | |
6f49a57a | 240 | |
d2f4f99d MR |
241 | if (!dma_has_cap(DMA_PRIVATE, chan->device->cap_mask)) |
242 | balance_ref_count(chan); | |
243 | ||
244 | out: | |
245 | chan->client_count++; | |
246 | return 0; | |
247 | ||
248 | err_out: | |
249 | module_put(owner); | |
250 | return ret; | |
6f49a57a DW |
251 | } |
252 | ||
253 | /** | |
254 | * dma_chan_put - drop a reference to a dma channel's parent driver module | |
255 | * @chan - channel to release | |
256 | * | |
257 | * Must be called under dma_list_mutex | |
258 | */ | |
259 | static void dma_chan_put(struct dma_chan *chan) | |
260 | { | |
c4b54a64 | 261 | /* This channel is not in use, bail out */ |
6f49a57a | 262 | if (!chan->client_count) |
c4b54a64 MR |
263 | return; |
264 | ||
6f49a57a DW |
265 | chan->client_count--; |
266 | module_put(dma_chan_to_owner(chan)); | |
c4b54a64 MR |
267 | |
268 | /* This channel is not in use anymore, free it */ | |
b36f09c3 LPC |
269 | if (!chan->client_count && chan->device->device_free_chan_resources) { |
270 | /* Make sure all operations have completed */ | |
271 | dmaengine_synchronize(chan); | |
6f49a57a | 272 | chan->device->device_free_chan_resources(chan); |
b36f09c3 | 273 | } |
56f13c0d PU |
274 | |
275 | /* If the channel is used via a DMA request router, free the mapping */ | |
276 | if (chan->router && chan->router->route_free) { | |
277 | chan->router->route_free(chan->router->dev, chan->route_data); | |
278 | chan->router = NULL; | |
279 | chan->route_data = NULL; | |
280 | } | |
6f49a57a DW |
281 | } |
282 | ||
7405f74b DW |
283 | enum dma_status dma_sync_wait(struct dma_chan *chan, dma_cookie_t cookie) |
284 | { | |
285 | enum dma_status status; | |
286 | unsigned long dma_sync_wait_timeout = jiffies + msecs_to_jiffies(5000); | |
287 | ||
288 | dma_async_issue_pending(chan); | |
289 | do { | |
290 | status = dma_async_is_tx_complete(chan, cookie, NULL, NULL); | |
291 | if (time_after_eq(jiffies, dma_sync_wait_timeout)) { | |
63433250 | 292 | pr_err("%s: timeout!\n", __func__); |
7405f74b DW |
293 | return DMA_ERROR; |
294 | } | |
2cbe7feb BZ |
295 | if (status != DMA_IN_PROGRESS) |
296 | break; | |
297 | cpu_relax(); | |
298 | } while (1); | |
7405f74b DW |
299 | |
300 | return status; | |
301 | } | |
302 | EXPORT_SYMBOL(dma_sync_wait); | |
303 | ||
bec08513 DW |
304 | /** |
305 | * dma_cap_mask_all - enable iteration over all operation types | |
306 | */ | |
307 | static dma_cap_mask_t dma_cap_mask_all; | |
308 | ||
309 | /** | |
310 | * dma_chan_tbl_ent - tracks channel allocations per core/operation | |
311 | * @chan - associated channel for this entry | |
312 | */ | |
313 | struct dma_chan_tbl_ent { | |
314 | struct dma_chan *chan; | |
315 | }; | |
316 | ||
317 | /** | |
318 | * channel_table - percpu lookup table for memory-to-memory offload providers | |
319 | */ | |
a29d8b8e | 320 | static struct dma_chan_tbl_ent __percpu *channel_table[DMA_TX_TYPE_END]; |
bec08513 DW |
321 | |
322 | static int __init dma_channel_table_init(void) | |
323 | { | |
324 | enum dma_transaction_type cap; | |
325 | int err = 0; | |
326 | ||
327 | bitmap_fill(dma_cap_mask_all.bits, DMA_TX_TYPE_END); | |
328 | ||
59b5ec21 DW |
329 | /* 'interrupt', 'private', and 'slave' are channel capabilities, |
330 | * but are not associated with an operation so they do not need | |
331 | * an entry in the channel_table | |
bec08513 DW |
332 | */ |
333 | clear_bit(DMA_INTERRUPT, dma_cap_mask_all.bits); | |
59b5ec21 | 334 | clear_bit(DMA_PRIVATE, dma_cap_mask_all.bits); |
bec08513 DW |
335 | clear_bit(DMA_SLAVE, dma_cap_mask_all.bits); |
336 | ||
337 | for_each_dma_cap_mask(cap, dma_cap_mask_all) { | |
338 | channel_table[cap] = alloc_percpu(struct dma_chan_tbl_ent); | |
339 | if (!channel_table[cap]) { | |
340 | err = -ENOMEM; | |
341 | break; | |
342 | } | |
343 | } | |
344 | ||
345 | if (err) { | |
63433250 | 346 | pr_err("initialization failure\n"); |
bec08513 | 347 | for_each_dma_cap_mask(cap, dma_cap_mask_all) |
a9507ca3 | 348 | free_percpu(channel_table[cap]); |
bec08513 DW |
349 | } |
350 | ||
351 | return err; | |
352 | } | |
652afc27 | 353 | arch_initcall(dma_channel_table_init); |
bec08513 DW |
354 | |
355 | /** | |
356 | * dma_find_channel - find a channel to carry out the operation | |
357 | * @tx_type: transaction type | |
358 | */ | |
359 | struct dma_chan *dma_find_channel(enum dma_transaction_type tx_type) | |
360 | { | |
e7dcaa47 | 361 | return this_cpu_read(channel_table[tx_type]->chan); |
bec08513 DW |
362 | } |
363 | EXPORT_SYMBOL(dma_find_channel); | |
a2bd1140 | 364 | |
2ba05622 DW |
365 | /** |
366 | * dma_issue_pending_all - flush all pending operations across all channels | |
367 | */ | |
368 | void dma_issue_pending_all(void) | |
369 | { | |
370 | struct dma_device *device; | |
371 | struct dma_chan *chan; | |
372 | ||
2ba05622 | 373 | rcu_read_lock(); |
59b5ec21 DW |
374 | list_for_each_entry_rcu(device, &dma_device_list, global_node) { |
375 | if (dma_has_cap(DMA_PRIVATE, device->cap_mask)) | |
376 | continue; | |
2ba05622 DW |
377 | list_for_each_entry(chan, &device->channels, device_node) |
378 | if (chan->client_count) | |
379 | device->device_issue_pending(chan); | |
59b5ec21 | 380 | } |
2ba05622 DW |
381 | rcu_read_unlock(); |
382 | } | |
383 | EXPORT_SYMBOL(dma_issue_pending_all); | |
384 | ||
bec08513 | 385 | /** |
c4d27c4d BG |
386 | * dma_chan_is_local - returns true if the channel is in the same numa-node as the cpu |
387 | */ | |
388 | static bool dma_chan_is_local(struct dma_chan *chan, int cpu) | |
389 | { | |
390 | int node = dev_to_node(chan->device->dev); | |
391 | return node == -1 || cpumask_test_cpu(cpu, cpumask_of_node(node)); | |
392 | } | |
393 | ||
394 | /** | |
395 | * min_chan - returns the channel with min count and in the same numa-node as the cpu | |
bec08513 | 396 | * @cap: capability to match |
c4d27c4d | 397 | * @cpu: cpu index which the channel should be close to |
bec08513 | 398 | * |
c4d27c4d BG |
399 | * If some channels are close to the given cpu, the one with the lowest |
400 | * reference count is returned. Otherwise, cpu is ignored and only the | |
401 | * reference count is taken into account. | |
402 | * Must be called under dma_list_mutex. | |
bec08513 | 403 | */ |
c4d27c4d | 404 | static struct dma_chan *min_chan(enum dma_transaction_type cap, int cpu) |
bec08513 DW |
405 | { |
406 | struct dma_device *device; | |
407 | struct dma_chan *chan; | |
bec08513 | 408 | struct dma_chan *min = NULL; |
c4d27c4d | 409 | struct dma_chan *localmin = NULL; |
bec08513 DW |
410 | |
411 | list_for_each_entry(device, &dma_device_list, global_node) { | |
59b5ec21 DW |
412 | if (!dma_has_cap(cap, device->cap_mask) || |
413 | dma_has_cap(DMA_PRIVATE, device->cap_mask)) | |
bec08513 DW |
414 | continue; |
415 | list_for_each_entry(chan, &device->channels, device_node) { | |
416 | if (!chan->client_count) | |
417 | continue; | |
c4d27c4d | 418 | if (!min || chan->table_count < min->table_count) |
bec08513 DW |
419 | min = chan; |
420 | ||
c4d27c4d BG |
421 | if (dma_chan_is_local(chan, cpu)) |
422 | if (!localmin || | |
423 | chan->table_count < localmin->table_count) | |
424 | localmin = chan; | |
bec08513 | 425 | } |
bec08513 DW |
426 | } |
427 | ||
c4d27c4d | 428 | chan = localmin ? localmin : min; |
bec08513 | 429 | |
c4d27c4d BG |
430 | if (chan) |
431 | chan->table_count++; | |
bec08513 | 432 | |
c4d27c4d | 433 | return chan; |
bec08513 DW |
434 | } |
435 | ||
436 | /** | |
437 | * dma_channel_rebalance - redistribute the available channels | |
438 | * | |
439 | * Optimize for cpu isolation (each cpu gets a dedicated channel for an | |
440 | * operation type) in the SMP case, and operation isolation (avoid | |
441 | * multi-tasking channels) in the non-SMP case. Must be called under | |
442 | * dma_list_mutex. | |
443 | */ | |
444 | static void dma_channel_rebalance(void) | |
445 | { | |
446 | struct dma_chan *chan; | |
447 | struct dma_device *device; | |
448 | int cpu; | |
449 | int cap; | |
bec08513 DW |
450 | |
451 | /* undo the last distribution */ | |
452 | for_each_dma_cap_mask(cap, dma_cap_mask_all) | |
453 | for_each_possible_cpu(cpu) | |
454 | per_cpu_ptr(channel_table[cap], cpu)->chan = NULL; | |
455 | ||
59b5ec21 DW |
456 | list_for_each_entry(device, &dma_device_list, global_node) { |
457 | if (dma_has_cap(DMA_PRIVATE, device->cap_mask)) | |
458 | continue; | |
bec08513 DW |
459 | list_for_each_entry(chan, &device->channels, device_node) |
460 | chan->table_count = 0; | |
59b5ec21 | 461 | } |
bec08513 DW |
462 | |
463 | /* don't populate the channel_table if no clients are available */ | |
464 | if (!dmaengine_ref_count) | |
465 | return; | |
466 | ||
467 | /* redistribute available channels */ | |
bec08513 DW |
468 | for_each_dma_cap_mask(cap, dma_cap_mask_all) |
469 | for_each_online_cpu(cpu) { | |
c4d27c4d | 470 | chan = min_chan(cap, cpu); |
bec08513 DW |
471 | per_cpu_ptr(channel_table[cap], cpu)->chan = chan; |
472 | } | |
473 | } | |
474 | ||
0d5484b1 LP |
475 | int dma_get_slave_caps(struct dma_chan *chan, struct dma_slave_caps *caps) |
476 | { | |
477 | struct dma_device *device; | |
478 | ||
479 | if (!chan || !caps) | |
480 | return -EINVAL; | |
481 | ||
482 | device = chan->device; | |
483 | ||
484 | /* check if the channel supports slave transactions */ | |
485 | if (!test_bit(DMA_SLAVE, device->cap_mask.bits)) | |
486 | return -ENXIO; | |
487 | ||
488 | /* | |
489 | * Check whether it reports it uses the generic slave | |
490 | * capabilities, if not, that means it doesn't support any | |
491 | * kind of slave capabilities reporting. | |
492 | */ | |
493 | if (!device->directions) | |
494 | return -ENXIO; | |
495 | ||
496 | caps->src_addr_widths = device->src_addr_widths; | |
497 | caps->dst_addr_widths = device->dst_addr_widths; | |
498 | caps->directions = device->directions; | |
6d5bbed3 | 499 | caps->max_burst = device->max_burst; |
0d5484b1 | 500 | caps->residue_granularity = device->residue_granularity; |
9eeacd3a | 501 | caps->descriptor_reuse = device->descriptor_reuse; |
0d5484b1 | 502 | |
88d04643 KK |
503 | /* |
504 | * Some devices implement only pause (e.g. to get residuum) but no | |
505 | * resume. However cmd_pause is advertised as pause AND resume. | |
506 | */ | |
507 | caps->cmd_pause = !!(device->device_pause && device->device_resume); | |
0d5484b1 LP |
508 | caps->cmd_terminate = !!device->device_terminate_all; |
509 | ||
510 | return 0; | |
511 | } | |
512 | EXPORT_SYMBOL_GPL(dma_get_slave_caps); | |
513 | ||
a53e28da LPC |
514 | static struct dma_chan *private_candidate(const dma_cap_mask_t *mask, |
515 | struct dma_device *dev, | |
e2346677 | 516 | dma_filter_fn fn, void *fn_param) |
59b5ec21 DW |
517 | { |
518 | struct dma_chan *chan; | |
59b5ec21 | 519 | |
26b64256 | 520 | if (mask && !__dma_device_satisfies_mask(dev, mask)) { |
59b5ec21 DW |
521 | pr_debug("%s: wrong capabilities\n", __func__); |
522 | return NULL; | |
523 | } | |
524 | /* devices with multiple channels need special handling as we need to | |
525 | * ensure that all channels are either private or public. | |
526 | */ | |
527 | if (dev->chancnt > 1 && !dma_has_cap(DMA_PRIVATE, dev->cap_mask)) | |
528 | list_for_each_entry(chan, &dev->channels, device_node) { | |
529 | /* some channels are already publicly allocated */ | |
530 | if (chan->client_count) | |
531 | return NULL; | |
532 | } | |
533 | ||
534 | list_for_each_entry(chan, &dev->channels, device_node) { | |
535 | if (chan->client_count) { | |
536 | pr_debug("%s: %s busy\n", | |
41d5e59c | 537 | __func__, dma_chan_name(chan)); |
59b5ec21 DW |
538 | continue; |
539 | } | |
e2346677 DW |
540 | if (fn && !fn(chan, fn_param)) { |
541 | pr_debug("%s: %s filter said false\n", | |
542 | __func__, dma_chan_name(chan)); | |
543 | continue; | |
544 | } | |
545 | return chan; | |
59b5ec21 DW |
546 | } |
547 | ||
e2346677 | 548 | return NULL; |
59b5ec21 DW |
549 | } |
550 | ||
7bd903c5 PU |
551 | static struct dma_chan *find_candidate(struct dma_device *device, |
552 | const dma_cap_mask_t *mask, | |
553 | dma_filter_fn fn, void *fn_param) | |
554 | { | |
555 | struct dma_chan *chan = private_candidate(mask, device, fn, fn_param); | |
556 | int err; | |
557 | ||
558 | if (chan) { | |
559 | /* Found a suitable channel, try to grab, prep, and return it. | |
560 | * We first set DMA_PRIVATE to disable balance_ref_count as this | |
561 | * channel will not be published in the general-purpose | |
562 | * allocator | |
563 | */ | |
564 | dma_cap_set(DMA_PRIVATE, device->cap_mask); | |
565 | device->privatecnt++; | |
566 | err = dma_chan_get(chan); | |
567 | ||
568 | if (err) { | |
569 | if (err == -ENODEV) { | |
570 | pr_debug("%s: %s module removed\n", __func__, | |
571 | dma_chan_name(chan)); | |
572 | list_del_rcu(&device->global_node); | |
573 | } else | |
574 | pr_debug("%s: failed to get %s: (%d)\n", | |
575 | __func__, dma_chan_name(chan), err); | |
576 | ||
577 | if (--device->privatecnt == 0) | |
578 | dma_cap_clear(DMA_PRIVATE, device->cap_mask); | |
579 | ||
580 | chan = ERR_PTR(err); | |
581 | } | |
582 | } | |
583 | ||
584 | return chan ? chan : ERR_PTR(-EPROBE_DEFER); | |
585 | } | |
586 | ||
59b5ec21 | 587 | /** |
19d643d6 | 588 | * dma_get_slave_channel - try to get specific channel exclusively |
7bb587f4 ZG |
589 | * @chan: target channel |
590 | */ | |
591 | struct dma_chan *dma_get_slave_channel(struct dma_chan *chan) | |
592 | { | |
593 | int err = -EBUSY; | |
594 | ||
595 | /* lock against __dma_request_channel */ | |
596 | mutex_lock(&dma_list_mutex); | |
597 | ||
d9a6c8f5 | 598 | if (chan->client_count == 0) { |
214fc4e4 PU |
599 | struct dma_device *device = chan->device; |
600 | ||
601 | dma_cap_set(DMA_PRIVATE, device->cap_mask); | |
602 | device->privatecnt++; | |
7bb587f4 | 603 | err = dma_chan_get(chan); |
214fc4e4 | 604 | if (err) { |
d9a6c8f5 VK |
605 | pr_debug("%s: failed to get %s: (%d)\n", |
606 | __func__, dma_chan_name(chan), err); | |
214fc4e4 PU |
607 | chan = NULL; |
608 | if (--device->privatecnt == 0) | |
609 | dma_cap_clear(DMA_PRIVATE, device->cap_mask); | |
610 | } | |
d9a6c8f5 | 611 | } else |
7bb587f4 ZG |
612 | chan = NULL; |
613 | ||
614 | mutex_unlock(&dma_list_mutex); | |
615 | ||
7bb587f4 ZG |
616 | |
617 | return chan; | |
618 | } | |
619 | EXPORT_SYMBOL_GPL(dma_get_slave_channel); | |
620 | ||
8010dad5 SW |
621 | struct dma_chan *dma_get_any_slave_channel(struct dma_device *device) |
622 | { | |
623 | dma_cap_mask_t mask; | |
624 | struct dma_chan *chan; | |
8010dad5 SW |
625 | |
626 | dma_cap_zero(mask); | |
627 | dma_cap_set(DMA_SLAVE, mask); | |
628 | ||
629 | /* lock against __dma_request_channel */ | |
630 | mutex_lock(&dma_list_mutex); | |
631 | ||
7bd903c5 | 632 | chan = find_candidate(device, &mask, NULL, NULL); |
8010dad5 SW |
633 | |
634 | mutex_unlock(&dma_list_mutex); | |
635 | ||
7bd903c5 | 636 | return IS_ERR(chan) ? NULL : chan; |
8010dad5 SW |
637 | } |
638 | EXPORT_SYMBOL_GPL(dma_get_any_slave_channel); | |
639 | ||
59b5ec21 | 640 | /** |
6b9019a7 | 641 | * __dma_request_channel - try to allocate an exclusive channel |
59b5ec21 DW |
642 | * @mask: capabilities that the channel must satisfy |
643 | * @fn: optional callback to disposition available channels | |
644 | * @fn_param: opaque parameter to pass to dma_filter_fn | |
0ad7c000 SW |
645 | * |
646 | * Returns pointer to appropriate DMA channel on success or NULL. | |
59b5ec21 | 647 | */ |
a53e28da LPC |
648 | struct dma_chan *__dma_request_channel(const dma_cap_mask_t *mask, |
649 | dma_filter_fn fn, void *fn_param) | |
59b5ec21 DW |
650 | { |
651 | struct dma_device *device, *_d; | |
652 | struct dma_chan *chan = NULL; | |
59b5ec21 DW |
653 | |
654 | /* Find a channel */ | |
655 | mutex_lock(&dma_list_mutex); | |
656 | list_for_each_entry_safe(device, _d, &dma_device_list, global_node) { | |
7bd903c5 PU |
657 | chan = find_candidate(device, mask, fn, fn_param); |
658 | if (!IS_ERR(chan)) | |
659 | break; | |
59b5ec21 | 660 | |
7bd903c5 | 661 | chan = NULL; |
59b5ec21 DW |
662 | } |
663 | mutex_unlock(&dma_list_mutex); | |
664 | ||
63433250 JP |
665 | pr_debug("%s: %s (%s)\n", |
666 | __func__, | |
667 | chan ? "success" : "fail", | |
41d5e59c | 668 | chan ? dma_chan_name(chan) : NULL); |
59b5ec21 DW |
669 | |
670 | return chan; | |
671 | } | |
672 | EXPORT_SYMBOL_GPL(__dma_request_channel); | |
673 | ||
a8135d0d PU |
674 | static const struct dma_slave_map *dma_filter_match(struct dma_device *device, |
675 | const char *name, | |
676 | struct device *dev) | |
677 | { | |
678 | int i; | |
679 | ||
680 | if (!device->filter.mapcnt) | |
681 | return NULL; | |
682 | ||
683 | for (i = 0; i < device->filter.mapcnt; i++) { | |
684 | const struct dma_slave_map *map = &device->filter.map[i]; | |
685 | ||
686 | if (!strcmp(map->devname, dev_name(dev)) && | |
687 | !strcmp(map->slave, name)) | |
688 | return map; | |
689 | } | |
690 | ||
691 | return NULL; | |
692 | } | |
693 | ||
9a6cecc8 | 694 | /** |
a8135d0d | 695 | * dma_request_chan - try to allocate an exclusive slave channel |
9a6cecc8 JH |
696 | * @dev: pointer to client device structure |
697 | * @name: slave channel name | |
0ad7c000 SW |
698 | * |
699 | * Returns pointer to appropriate DMA channel on success or an error pointer. | |
9a6cecc8 | 700 | */ |
a8135d0d | 701 | struct dma_chan *dma_request_chan(struct device *dev, const char *name) |
9a6cecc8 | 702 | { |
a8135d0d PU |
703 | struct dma_device *d, *_d; |
704 | struct dma_chan *chan = NULL; | |
705 | ||
9a6cecc8 JH |
706 | /* If device-tree is present get slave info from here */ |
707 | if (dev->of_node) | |
a8135d0d | 708 | chan = of_dma_request_slave_channel(dev->of_node, name); |
9a6cecc8 | 709 | |
4e82f5dd | 710 | /* If device was enumerated by ACPI get slave info from here */ |
a8135d0d PU |
711 | if (has_acpi_companion(dev) && !chan) |
712 | chan = acpi_dma_request_slave_chan_by_name(dev, name); | |
713 | ||
714 | if (chan) { | |
715 | /* Valid channel found or requester need to be deferred */ | |
716 | if (!IS_ERR(chan) || PTR_ERR(chan) == -EPROBE_DEFER) | |
717 | return chan; | |
718 | } | |
719 | ||
720 | /* Try to find the channel via the DMA filter map(s) */ | |
721 | mutex_lock(&dma_list_mutex); | |
722 | list_for_each_entry_safe(d, _d, &dma_device_list, global_node) { | |
723 | dma_cap_mask_t mask; | |
724 | const struct dma_slave_map *map = dma_filter_match(d, name, dev); | |
4e82f5dd | 725 | |
a8135d0d PU |
726 | if (!map) |
727 | continue; | |
728 | ||
729 | dma_cap_zero(mask); | |
730 | dma_cap_set(DMA_SLAVE, mask); | |
4e82f5dd | 731 | |
a8135d0d PU |
732 | chan = find_candidate(d, &mask, d->filter.fn, map->param); |
733 | if (!IS_ERR(chan)) | |
734 | break; | |
735 | } | |
736 | mutex_unlock(&dma_list_mutex); | |
737 | ||
738 | return chan ? chan : ERR_PTR(-EPROBE_DEFER); | |
0ad7c000 | 739 | } |
a8135d0d | 740 | EXPORT_SYMBOL_GPL(dma_request_chan); |
0ad7c000 SW |
741 | |
742 | /** | |
743 | * dma_request_slave_channel - try to allocate an exclusive slave channel | |
744 | * @dev: pointer to client device structure | |
745 | * @name: slave channel name | |
746 | * | |
747 | * Returns pointer to appropriate DMA channel on success or NULL. | |
748 | */ | |
749 | struct dma_chan *dma_request_slave_channel(struct device *dev, | |
750 | const char *name) | |
751 | { | |
a8135d0d | 752 | struct dma_chan *ch = dma_request_chan(dev, name); |
0ad7c000 SW |
753 | if (IS_ERR(ch)) |
754 | return NULL; | |
05aa1a77 | 755 | |
0ad7c000 | 756 | return ch; |
9a6cecc8 JH |
757 | } |
758 | EXPORT_SYMBOL_GPL(dma_request_slave_channel); | |
759 | ||
a8135d0d PU |
760 | /** |
761 | * dma_request_chan_by_mask - allocate a channel satisfying certain capabilities | |
762 | * @mask: capabilities that the channel must satisfy | |
763 | * | |
764 | * Returns pointer to appropriate DMA channel on success or an error pointer. | |
765 | */ | |
766 | struct dma_chan *dma_request_chan_by_mask(const dma_cap_mask_t *mask) | |
767 | { | |
768 | struct dma_chan *chan; | |
769 | ||
770 | if (!mask) | |
771 | return ERR_PTR(-ENODEV); | |
772 | ||
773 | chan = __dma_request_channel(mask, NULL, NULL); | |
774 | if (!chan) | |
775 | chan = ERR_PTR(-ENODEV); | |
776 | ||
777 | return chan; | |
778 | } | |
779 | EXPORT_SYMBOL_GPL(dma_request_chan_by_mask); | |
780 | ||
59b5ec21 DW |
781 | void dma_release_channel(struct dma_chan *chan) |
782 | { | |
783 | mutex_lock(&dma_list_mutex); | |
784 | WARN_ONCE(chan->client_count != 1, | |
785 | "chan reference count %d != 1\n", chan->client_count); | |
786 | dma_chan_put(chan); | |
0f571515 AN |
787 | /* drop PRIVATE cap enabled by __dma_request_channel() */ |
788 | if (--chan->device->privatecnt == 0) | |
789 | dma_cap_clear(DMA_PRIVATE, chan->device->cap_mask); | |
59b5ec21 DW |
790 | mutex_unlock(&dma_list_mutex); |
791 | } | |
792 | EXPORT_SYMBOL_GPL(dma_release_channel); | |
793 | ||
d379b01e | 794 | /** |
209b84a8 | 795 | * dmaengine_get - register interest in dma_channels |
d379b01e | 796 | */ |
209b84a8 | 797 | void dmaengine_get(void) |
d379b01e | 798 | { |
6f49a57a DW |
799 | struct dma_device *device, *_d; |
800 | struct dma_chan *chan; | |
801 | int err; | |
802 | ||
c13c8260 | 803 | mutex_lock(&dma_list_mutex); |
6f49a57a DW |
804 | dmaengine_ref_count++; |
805 | ||
806 | /* try to grab channels */ | |
59b5ec21 DW |
807 | list_for_each_entry_safe(device, _d, &dma_device_list, global_node) { |
808 | if (dma_has_cap(DMA_PRIVATE, device->cap_mask)) | |
809 | continue; | |
6f49a57a DW |
810 | list_for_each_entry(chan, &device->channels, device_node) { |
811 | err = dma_chan_get(chan); | |
812 | if (err == -ENODEV) { | |
813 | /* module removed before we could use it */ | |
2ba05622 | 814 | list_del_rcu(&device->global_node); |
6f49a57a DW |
815 | break; |
816 | } else if (err) | |
0eb5a358 | 817 | pr_debug("%s: failed to get %s: (%d)\n", |
63433250 | 818 | __func__, dma_chan_name(chan), err); |
6f49a57a | 819 | } |
59b5ec21 | 820 | } |
6f49a57a | 821 | |
bec08513 DW |
822 | /* if this is the first reference and there were channels |
823 | * waiting we need to rebalance to get those channels | |
824 | * incorporated into the channel table | |
825 | */ | |
826 | if (dmaengine_ref_count == 1) | |
827 | dma_channel_rebalance(); | |
c13c8260 | 828 | mutex_unlock(&dma_list_mutex); |
c13c8260 | 829 | } |
209b84a8 | 830 | EXPORT_SYMBOL(dmaengine_get); |
c13c8260 CL |
831 | |
832 | /** | |
209b84a8 | 833 | * dmaengine_put - let dma drivers be removed when ref_count == 0 |
c13c8260 | 834 | */ |
209b84a8 | 835 | void dmaengine_put(void) |
c13c8260 | 836 | { |
d379b01e | 837 | struct dma_device *device; |
c13c8260 CL |
838 | struct dma_chan *chan; |
839 | ||
c13c8260 | 840 | mutex_lock(&dma_list_mutex); |
6f49a57a DW |
841 | dmaengine_ref_count--; |
842 | BUG_ON(dmaengine_ref_count < 0); | |
843 | /* drop channel references */ | |
59b5ec21 DW |
844 | list_for_each_entry(device, &dma_device_list, global_node) { |
845 | if (dma_has_cap(DMA_PRIVATE, device->cap_mask)) | |
846 | continue; | |
6f49a57a DW |
847 | list_for_each_entry(chan, &device->channels, device_node) |
848 | dma_chan_put(chan); | |
59b5ec21 | 849 | } |
c13c8260 | 850 | mutex_unlock(&dma_list_mutex); |
c13c8260 | 851 | } |
209b84a8 | 852 | EXPORT_SYMBOL(dmaengine_put); |
c13c8260 | 853 | |
138f4c35 DW |
854 | static bool device_has_all_tx_types(struct dma_device *device) |
855 | { | |
856 | /* A device that satisfies this test has channels that will never cause | |
857 | * an async_tx channel switch event as all possible operation types can | |
858 | * be handled. | |
859 | */ | |
860 | #ifdef CONFIG_ASYNC_TX_DMA | |
861 | if (!dma_has_cap(DMA_INTERRUPT, device->cap_mask)) | |
862 | return false; | |
863 | #endif | |
864 | ||
865 | #if defined(CONFIG_ASYNC_MEMCPY) || defined(CONFIG_ASYNC_MEMCPY_MODULE) | |
866 | if (!dma_has_cap(DMA_MEMCPY, device->cap_mask)) | |
867 | return false; | |
868 | #endif | |
869 | ||
138f4c35 DW |
870 | #if defined(CONFIG_ASYNC_XOR) || defined(CONFIG_ASYNC_XOR_MODULE) |
871 | if (!dma_has_cap(DMA_XOR, device->cap_mask)) | |
872 | return false; | |
7b3cc2b1 DW |
873 | |
874 | #ifndef CONFIG_ASYNC_TX_DISABLE_XOR_VAL_DMA | |
4499a24d DW |
875 | if (!dma_has_cap(DMA_XOR_VAL, device->cap_mask)) |
876 | return false; | |
138f4c35 | 877 | #endif |
7b3cc2b1 | 878 | #endif |
138f4c35 DW |
879 | |
880 | #if defined(CONFIG_ASYNC_PQ) || defined(CONFIG_ASYNC_PQ_MODULE) | |
881 | if (!dma_has_cap(DMA_PQ, device->cap_mask)) | |
882 | return false; | |
7b3cc2b1 DW |
883 | |
884 | #ifndef CONFIG_ASYNC_TX_DISABLE_PQ_VAL_DMA | |
4499a24d DW |
885 | if (!dma_has_cap(DMA_PQ_VAL, device->cap_mask)) |
886 | return false; | |
138f4c35 | 887 | #endif |
7b3cc2b1 | 888 | #endif |
138f4c35 DW |
889 | |
890 | return true; | |
891 | } | |
892 | ||
257b17ca DW |
893 | static int get_dma_id(struct dma_device *device) |
894 | { | |
895 | int rc; | |
896 | ||
257b17ca | 897 | mutex_lock(&dma_list_mutex); |
257b17ca | 898 | |
69ee266b TH |
899 | rc = idr_alloc(&dma_idr, NULL, 0, 0, GFP_KERNEL); |
900 | if (rc >= 0) | |
901 | device->dev_id = rc; | |
902 | ||
903 | mutex_unlock(&dma_list_mutex); | |
904 | return rc < 0 ? rc : 0; | |
257b17ca DW |
905 | } |
906 | ||
c13c8260 | 907 | /** |
6508871e | 908 | * dma_async_device_register - registers DMA devices found |
c13c8260 CL |
909 | * @device: &dma_device |
910 | */ | |
911 | int dma_async_device_register(struct dma_device *device) | |
912 | { | |
ff487fb7 | 913 | int chancnt = 0, rc; |
c13c8260 | 914 | struct dma_chan* chan; |
864498aa | 915 | atomic_t *idr_ref; |
c13c8260 CL |
916 | |
917 | if (!device) | |
918 | return -ENODEV; | |
919 | ||
7405f74b DW |
920 | /* validate device routines */ |
921 | BUG_ON(dma_has_cap(DMA_MEMCPY, device->cap_mask) && | |
922 | !device->device_prep_dma_memcpy); | |
923 | BUG_ON(dma_has_cap(DMA_XOR, device->cap_mask) && | |
924 | !device->device_prep_dma_xor); | |
099f53cb DW |
925 | BUG_ON(dma_has_cap(DMA_XOR_VAL, device->cap_mask) && |
926 | !device->device_prep_dma_xor_val); | |
b2f46fd8 DW |
927 | BUG_ON(dma_has_cap(DMA_PQ, device->cap_mask) && |
928 | !device->device_prep_dma_pq); | |
929 | BUG_ON(dma_has_cap(DMA_PQ_VAL, device->cap_mask) && | |
930 | !device->device_prep_dma_pq_val); | |
4983a501 MR |
931 | BUG_ON(dma_has_cap(DMA_MEMSET, device->cap_mask) && |
932 | !device->device_prep_dma_memset); | |
9b941c66 | 933 | BUG_ON(dma_has_cap(DMA_INTERRUPT, device->cap_mask) && |
7405f74b | 934 | !device->device_prep_dma_interrupt); |
a86ee03c IS |
935 | BUG_ON(dma_has_cap(DMA_SG, device->cap_mask) && |
936 | !device->device_prep_dma_sg); | |
782bc950 SH |
937 | BUG_ON(dma_has_cap(DMA_CYCLIC, device->cap_mask) && |
938 | !device->device_prep_dma_cyclic); | |
b14dab79 JB |
939 | BUG_ON(dma_has_cap(DMA_INTERLEAVE, device->cap_mask) && |
940 | !device->device_prep_interleaved_dma); | |
7405f74b | 941 | |
07934481 | 942 | BUG_ON(!device->device_tx_status); |
7405f74b DW |
943 | BUG_ON(!device->device_issue_pending); |
944 | BUG_ON(!device->dev); | |
945 | ||
138f4c35 | 946 | /* note: this only matters in the |
5fc6d897 | 947 | * CONFIG_ASYNC_TX_ENABLE_CHANNEL_SWITCH=n case |
138f4c35 DW |
948 | */ |
949 | if (device_has_all_tx_types(device)) | |
950 | dma_cap_set(DMA_ASYNC_TX, device->cap_mask); | |
951 | ||
864498aa DW |
952 | idr_ref = kmalloc(sizeof(*idr_ref), GFP_KERNEL); |
953 | if (!idr_ref) | |
954 | return -ENOMEM; | |
257b17ca DW |
955 | rc = get_dma_id(device); |
956 | if (rc != 0) { | |
957 | kfree(idr_ref); | |
864498aa | 958 | return rc; |
257b17ca DW |
959 | } |
960 | ||
961 | atomic_set(idr_ref, 0); | |
c13c8260 CL |
962 | |
963 | /* represent channels in sysfs. Probably want devs too */ | |
964 | list_for_each_entry(chan, &device->channels, device_node) { | |
257b17ca | 965 | rc = -ENOMEM; |
c13c8260 CL |
966 | chan->local = alloc_percpu(typeof(*chan->local)); |
967 | if (chan->local == NULL) | |
257b17ca | 968 | goto err_out; |
41d5e59c DW |
969 | chan->dev = kzalloc(sizeof(*chan->dev), GFP_KERNEL); |
970 | if (chan->dev == NULL) { | |
971 | free_percpu(chan->local); | |
257b17ca DW |
972 | chan->local = NULL; |
973 | goto err_out; | |
41d5e59c | 974 | } |
c13c8260 CL |
975 | |
976 | chan->chan_id = chancnt++; | |
41d5e59c DW |
977 | chan->dev->device.class = &dma_devclass; |
978 | chan->dev->device.parent = device->dev; | |
979 | chan->dev->chan = chan; | |
864498aa DW |
980 | chan->dev->idr_ref = idr_ref; |
981 | chan->dev->dev_id = device->dev_id; | |
982 | atomic_inc(idr_ref); | |
41d5e59c | 983 | dev_set_name(&chan->dev->device, "dma%dchan%d", |
06190d84 | 984 | device->dev_id, chan->chan_id); |
c13c8260 | 985 | |
41d5e59c | 986 | rc = device_register(&chan->dev->device); |
ff487fb7 | 987 | if (rc) { |
ff487fb7 JG |
988 | free_percpu(chan->local); |
989 | chan->local = NULL; | |
257b17ca DW |
990 | kfree(chan->dev); |
991 | atomic_dec(idr_ref); | |
ff487fb7 JG |
992 | goto err_out; |
993 | } | |
7cc5bf9a | 994 | chan->client_count = 0; |
c13c8260 | 995 | } |
59b5ec21 | 996 | device->chancnt = chancnt; |
c13c8260 CL |
997 | |
998 | mutex_lock(&dma_list_mutex); | |
59b5ec21 DW |
999 | /* take references on public channels */ |
1000 | if (dmaengine_ref_count && !dma_has_cap(DMA_PRIVATE, device->cap_mask)) | |
6f49a57a DW |
1001 | list_for_each_entry(chan, &device->channels, device_node) { |
1002 | /* if clients are already waiting for channels we need | |
1003 | * to take references on their behalf | |
1004 | */ | |
1005 | if (dma_chan_get(chan) == -ENODEV) { | |
1006 | /* note we can only get here for the first | |
1007 | * channel as the remaining channels are | |
1008 | * guaranteed to get a reference | |
1009 | */ | |
1010 | rc = -ENODEV; | |
1011 | mutex_unlock(&dma_list_mutex); | |
1012 | goto err_out; | |
1013 | } | |
1014 | } | |
2ba05622 | 1015 | list_add_tail_rcu(&device->global_node, &dma_device_list); |
0f571515 AN |
1016 | if (dma_has_cap(DMA_PRIVATE, device->cap_mask)) |
1017 | device->privatecnt++; /* Always private */ | |
bec08513 | 1018 | dma_channel_rebalance(); |
c13c8260 CL |
1019 | mutex_unlock(&dma_list_mutex); |
1020 | ||
c13c8260 | 1021 | return 0; |
ff487fb7 JG |
1022 | |
1023 | err_out: | |
257b17ca DW |
1024 | /* if we never registered a channel just release the idr */ |
1025 | if (atomic_read(idr_ref) == 0) { | |
1026 | mutex_lock(&dma_list_mutex); | |
1027 | idr_remove(&dma_idr, device->dev_id); | |
1028 | mutex_unlock(&dma_list_mutex); | |
1029 | kfree(idr_ref); | |
1030 | return rc; | |
1031 | } | |
1032 | ||
ff487fb7 JG |
1033 | list_for_each_entry(chan, &device->channels, device_node) { |
1034 | if (chan->local == NULL) | |
1035 | continue; | |
41d5e59c DW |
1036 | mutex_lock(&dma_list_mutex); |
1037 | chan->dev->chan = NULL; | |
1038 | mutex_unlock(&dma_list_mutex); | |
1039 | device_unregister(&chan->dev->device); | |
ff487fb7 JG |
1040 | free_percpu(chan->local); |
1041 | } | |
1042 | return rc; | |
c13c8260 | 1043 | } |
765e3d8a | 1044 | EXPORT_SYMBOL(dma_async_device_register); |
c13c8260 | 1045 | |
6508871e | 1046 | /** |
6f49a57a | 1047 | * dma_async_device_unregister - unregister a DMA device |
6508871e | 1048 | * @device: &dma_device |
f27c580c DW |
1049 | * |
1050 | * This routine is called by dma driver exit routines, dmaengine holds module | |
1051 | * references to prevent it being called while channels are in use. | |
6508871e RD |
1052 | */ |
1053 | void dma_async_device_unregister(struct dma_device *device) | |
c13c8260 CL |
1054 | { |
1055 | struct dma_chan *chan; | |
c13c8260 CL |
1056 | |
1057 | mutex_lock(&dma_list_mutex); | |
2ba05622 | 1058 | list_del_rcu(&device->global_node); |
bec08513 | 1059 | dma_channel_rebalance(); |
c13c8260 CL |
1060 | mutex_unlock(&dma_list_mutex); |
1061 | ||
1062 | list_for_each_entry(chan, &device->channels, device_node) { | |
6f49a57a DW |
1063 | WARN_ONCE(chan->client_count, |
1064 | "%s called while %d clients hold a reference\n", | |
1065 | __func__, chan->client_count); | |
41d5e59c DW |
1066 | mutex_lock(&dma_list_mutex); |
1067 | chan->dev->chan = NULL; | |
1068 | mutex_unlock(&dma_list_mutex); | |
1069 | device_unregister(&chan->dev->device); | |
adef4772 | 1070 | free_percpu(chan->local); |
c13c8260 | 1071 | } |
c13c8260 | 1072 | } |
765e3d8a | 1073 | EXPORT_SYMBOL(dma_async_device_unregister); |
c13c8260 | 1074 | |
45c463ae DW |
1075 | struct dmaengine_unmap_pool { |
1076 | struct kmem_cache *cache; | |
1077 | const char *name; | |
1078 | mempool_t *pool; | |
1079 | size_t size; | |
1080 | }; | |
7405f74b | 1081 | |
45c463ae DW |
1082 | #define __UNMAP_POOL(x) { .size = x, .name = "dmaengine-unmap-" __stringify(x) } |
1083 | static struct dmaengine_unmap_pool unmap_pool[] = { | |
1084 | __UNMAP_POOL(2), | |
3cc377b9 | 1085 | #if IS_ENABLED(CONFIG_DMA_ENGINE_RAID) |
45c463ae DW |
1086 | __UNMAP_POOL(16), |
1087 | __UNMAP_POOL(128), | |
1088 | __UNMAP_POOL(256), | |
1089 | #endif | |
1090 | }; | |
0036731c | 1091 | |
45c463ae DW |
1092 | static struct dmaengine_unmap_pool *__get_unmap_pool(int nr) |
1093 | { | |
1094 | int order = get_count_order(nr); | |
1095 | ||
1096 | switch (order) { | |
1097 | case 0 ... 1: | |
1098 | return &unmap_pool[0]; | |
1099 | case 2 ... 4: | |
1100 | return &unmap_pool[1]; | |
1101 | case 5 ... 7: | |
1102 | return &unmap_pool[2]; | |
1103 | case 8: | |
1104 | return &unmap_pool[3]; | |
1105 | default: | |
1106 | BUG(); | |
1107 | return NULL; | |
0036731c | 1108 | } |
45c463ae | 1109 | } |
7405f74b | 1110 | |
45c463ae DW |
1111 | static void dmaengine_unmap(struct kref *kref) |
1112 | { | |
1113 | struct dmaengine_unmap_data *unmap = container_of(kref, typeof(*unmap), kref); | |
1114 | struct device *dev = unmap->dev; | |
1115 | int cnt, i; | |
1116 | ||
1117 | cnt = unmap->to_cnt; | |
1118 | for (i = 0; i < cnt; i++) | |
1119 | dma_unmap_page(dev, unmap->addr[i], unmap->len, | |
1120 | DMA_TO_DEVICE); | |
1121 | cnt += unmap->from_cnt; | |
1122 | for (; i < cnt; i++) | |
1123 | dma_unmap_page(dev, unmap->addr[i], unmap->len, | |
1124 | DMA_FROM_DEVICE); | |
1125 | cnt += unmap->bidi_cnt; | |
7476bd79 DW |
1126 | for (; i < cnt; i++) { |
1127 | if (unmap->addr[i] == 0) | |
1128 | continue; | |
45c463ae DW |
1129 | dma_unmap_page(dev, unmap->addr[i], unmap->len, |
1130 | DMA_BIDIRECTIONAL); | |
7476bd79 | 1131 | } |
c1f43dd9 | 1132 | cnt = unmap->map_cnt; |
45c463ae DW |
1133 | mempool_free(unmap, __get_unmap_pool(cnt)->pool); |
1134 | } | |
7405f74b | 1135 | |
45c463ae DW |
1136 | void dmaengine_unmap_put(struct dmaengine_unmap_data *unmap) |
1137 | { | |
1138 | if (unmap) | |
1139 | kref_put(&unmap->kref, dmaengine_unmap); | |
1140 | } | |
1141 | EXPORT_SYMBOL_GPL(dmaengine_unmap_put); | |
7405f74b | 1142 | |
45c463ae DW |
1143 | static void dmaengine_destroy_unmap_pool(void) |
1144 | { | |
1145 | int i; | |
1146 | ||
1147 | for (i = 0; i < ARRAY_SIZE(unmap_pool); i++) { | |
1148 | struct dmaengine_unmap_pool *p = &unmap_pool[i]; | |
1149 | ||
240eb916 | 1150 | mempool_destroy(p->pool); |
45c463ae | 1151 | p->pool = NULL; |
240eb916 | 1152 | kmem_cache_destroy(p->cache); |
45c463ae DW |
1153 | p->cache = NULL; |
1154 | } | |
7405f74b | 1155 | } |
7405f74b | 1156 | |
45c463ae | 1157 | static int __init dmaengine_init_unmap_pool(void) |
7405f74b | 1158 | { |
45c463ae | 1159 | int i; |
7405f74b | 1160 | |
45c463ae DW |
1161 | for (i = 0; i < ARRAY_SIZE(unmap_pool); i++) { |
1162 | struct dmaengine_unmap_pool *p = &unmap_pool[i]; | |
1163 | size_t size; | |
0036731c | 1164 | |
45c463ae DW |
1165 | size = sizeof(struct dmaengine_unmap_data) + |
1166 | sizeof(dma_addr_t) * p->size; | |
1167 | ||
1168 | p->cache = kmem_cache_create(p->name, size, 0, | |
1169 | SLAB_HWCACHE_ALIGN, NULL); | |
1170 | if (!p->cache) | |
1171 | break; | |
1172 | p->pool = mempool_create_slab_pool(1, p->cache); | |
1173 | if (!p->pool) | |
1174 | break; | |
0036731c | 1175 | } |
7405f74b | 1176 | |
45c463ae DW |
1177 | if (i == ARRAY_SIZE(unmap_pool)) |
1178 | return 0; | |
7405f74b | 1179 | |
45c463ae DW |
1180 | dmaengine_destroy_unmap_pool(); |
1181 | return -ENOMEM; | |
1182 | } | |
7405f74b | 1183 | |
89716462 | 1184 | struct dmaengine_unmap_data * |
45c463ae DW |
1185 | dmaengine_get_unmap_data(struct device *dev, int nr, gfp_t flags) |
1186 | { | |
1187 | struct dmaengine_unmap_data *unmap; | |
1188 | ||
1189 | unmap = mempool_alloc(__get_unmap_pool(nr)->pool, flags); | |
1190 | if (!unmap) | |
1191 | return NULL; | |
1192 | ||
1193 | memset(unmap, 0, sizeof(*unmap)); | |
1194 | kref_init(&unmap->kref); | |
1195 | unmap->dev = dev; | |
c1f43dd9 | 1196 | unmap->map_cnt = nr; |
45c463ae DW |
1197 | |
1198 | return unmap; | |
7405f74b | 1199 | } |
89716462 | 1200 | EXPORT_SYMBOL(dmaengine_get_unmap_data); |
7405f74b | 1201 | |
7405f74b DW |
1202 | void dma_async_tx_descriptor_init(struct dma_async_tx_descriptor *tx, |
1203 | struct dma_chan *chan) | |
1204 | { | |
1205 | tx->chan = chan; | |
5fc6d897 | 1206 | #ifdef CONFIG_ASYNC_TX_ENABLE_CHANNEL_SWITCH |
7405f74b | 1207 | spin_lock_init(&tx->lock); |
caa20d97 | 1208 | #endif |
7405f74b DW |
1209 | } |
1210 | EXPORT_SYMBOL(dma_async_tx_descriptor_init); | |
1211 | ||
07f2211e DW |
1212 | /* dma_wait_for_async_tx - spin wait for a transaction to complete |
1213 | * @tx: in-flight transaction to wait on | |
07f2211e DW |
1214 | */ |
1215 | enum dma_status | |
1216 | dma_wait_for_async_tx(struct dma_async_tx_descriptor *tx) | |
1217 | { | |
95475e57 | 1218 | unsigned long dma_sync_wait_timeout = jiffies + msecs_to_jiffies(5000); |
07f2211e DW |
1219 | |
1220 | if (!tx) | |
adfedd9a | 1221 | return DMA_COMPLETE; |
07f2211e | 1222 | |
95475e57 DW |
1223 | while (tx->cookie == -EBUSY) { |
1224 | if (time_after_eq(jiffies, dma_sync_wait_timeout)) { | |
1225 | pr_err("%s timeout waiting for descriptor submission\n", | |
63433250 | 1226 | __func__); |
95475e57 DW |
1227 | return DMA_ERROR; |
1228 | } | |
1229 | cpu_relax(); | |
1230 | } | |
1231 | return dma_sync_wait(tx->chan, tx->cookie); | |
07f2211e DW |
1232 | } |
1233 | EXPORT_SYMBOL_GPL(dma_wait_for_async_tx); | |
1234 | ||
1235 | /* dma_run_dependencies - helper routine for dma drivers to process | |
1236 | * (start) dependent operations on their target channel | |
1237 | * @tx: transaction with dependencies | |
1238 | */ | |
1239 | void dma_run_dependencies(struct dma_async_tx_descriptor *tx) | |
1240 | { | |
caa20d97 | 1241 | struct dma_async_tx_descriptor *dep = txd_next(tx); |
07f2211e DW |
1242 | struct dma_async_tx_descriptor *dep_next; |
1243 | struct dma_chan *chan; | |
1244 | ||
1245 | if (!dep) | |
1246 | return; | |
1247 | ||
dd59b853 | 1248 | /* we'll submit tx->next now, so clear the link */ |
caa20d97 | 1249 | txd_clear_next(tx); |
07f2211e DW |
1250 | chan = dep->chan; |
1251 | ||
1252 | /* keep submitting up until a channel switch is detected | |
1253 | * in that case we will be called again as a result of | |
1254 | * processing the interrupt from async_tx_channel_switch | |
1255 | */ | |
1256 | for (; dep; dep = dep_next) { | |
caa20d97 DW |
1257 | txd_lock(dep); |
1258 | txd_clear_parent(dep); | |
1259 | dep_next = txd_next(dep); | |
07f2211e | 1260 | if (dep_next && dep_next->chan == chan) |
caa20d97 | 1261 | txd_clear_next(dep); /* ->next will be submitted */ |
07f2211e DW |
1262 | else |
1263 | dep_next = NULL; /* submit current dep and terminate */ | |
caa20d97 | 1264 | txd_unlock(dep); |
07f2211e DW |
1265 | |
1266 | dep->tx_submit(dep); | |
1267 | } | |
1268 | ||
1269 | chan->device->device_issue_pending(chan); | |
1270 | } | |
1271 | EXPORT_SYMBOL_GPL(dma_run_dependencies); | |
1272 | ||
c13c8260 CL |
1273 | static int __init dma_bus_init(void) |
1274 | { | |
45c463ae DW |
1275 | int err = dmaengine_init_unmap_pool(); |
1276 | ||
1277 | if (err) | |
1278 | return err; | |
c13c8260 CL |
1279 | return class_register(&dma_devclass); |
1280 | } | |
652afc27 | 1281 | arch_initcall(dma_bus_init); |
c13c8260 | 1282 | |
bec08513 | 1283 |