dma-debug.c 32 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303
  1. /*
  2. * Copyright (C) 2008 Advanced Micro Devices, Inc.
  3. *
  4. * Author: Joerg Roedel <joerg.roedel@amd.com>
  5. *
  6. * This program is free software; you can redistribute it and/or modify it
  7. * under the terms of the GNU General Public License version 2 as published
  8. * by the Free Software Foundation.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program; if not, write to the Free Software
  17. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  18. */
  19. #include <linux/scatterlist.h>
  20. #include <linux/dma-mapping.h>
  21. #include <linux/stacktrace.h>
  22. #include <linux/dma-debug.h>
  23. #include <linux/spinlock.h>
  24. #include <linux/debugfs.h>
  25. #include <linux/uaccess.h>
  26. #include <linux/device.h>
  27. #include <linux/types.h>
  28. #include <linux/sched.h>
  29. #include <linux/ctype.h>
  30. #include <linux/list.h>
  31. #include <linux/slab.h>
  32. #include <asm/sections.h>
  33. #define HASH_SIZE 1024ULL
  34. #define HASH_FN_SHIFT 13
  35. #define HASH_FN_MASK (HASH_SIZE - 1)
  36. enum {
  37. dma_debug_single,
  38. dma_debug_page,
  39. dma_debug_sg,
  40. dma_debug_coherent,
  41. };
  42. #define DMA_DEBUG_STACKTRACE_ENTRIES 5
  43. struct dma_debug_entry {
  44. struct list_head list;
  45. struct device *dev;
  46. int type;
  47. phys_addr_t paddr;
  48. u64 dev_addr;
  49. u64 size;
  50. int direction;
  51. int sg_call_ents;
  52. int sg_mapped_ents;
  53. #ifdef CONFIG_STACKTRACE
  54. struct stack_trace stacktrace;
  55. unsigned long st_entries[DMA_DEBUG_STACKTRACE_ENTRIES];
  56. #endif
  57. };
  58. struct hash_bucket {
  59. struct list_head list;
  60. spinlock_t lock;
  61. } ____cacheline_aligned_in_smp;
  62. /* Hash list to save the allocated dma addresses */
  63. static struct hash_bucket dma_entry_hash[HASH_SIZE];
  64. /* List of pre-allocated dma_debug_entry's */
  65. static LIST_HEAD(free_entries);
  66. /* Lock for the list above */
  67. static DEFINE_SPINLOCK(free_entries_lock);
  68. /* Global disable flag - will be set in case of an error */
  69. static bool global_disable __read_mostly;
  70. /* Global error count */
  71. static u32 error_count;
  72. /* Global error show enable*/
  73. static u32 show_all_errors __read_mostly;
  74. /* Number of errors to show */
  75. static u32 show_num_errors = 1;
  76. static u32 num_free_entries;
  77. static u32 min_free_entries;
  78. static u32 nr_total_entries;
  79. /* number of preallocated entries requested by kernel cmdline */
  80. static u32 req_entries;
  81. /* debugfs dentry's for the stuff above */
  82. static struct dentry *dma_debug_dent __read_mostly;
  83. static struct dentry *global_disable_dent __read_mostly;
  84. static struct dentry *error_count_dent __read_mostly;
  85. static struct dentry *show_all_errors_dent __read_mostly;
  86. static struct dentry *show_num_errors_dent __read_mostly;
  87. static struct dentry *num_free_entries_dent __read_mostly;
  88. static struct dentry *min_free_entries_dent __read_mostly;
  89. static struct dentry *filter_dent __read_mostly;
  90. /* per-driver filter related state */
  91. #define NAME_MAX_LEN 64
  92. static char current_driver_name[NAME_MAX_LEN] __read_mostly;
  93. static struct device_driver *current_driver __read_mostly;
  94. static DEFINE_RWLOCK(driver_name_lock);
  95. static const char *type2name[4] = { "single", "page",
  96. "scather-gather", "coherent" };
  97. static const char *dir2name[4] = { "DMA_BIDIRECTIONAL", "DMA_TO_DEVICE",
  98. "DMA_FROM_DEVICE", "DMA_NONE" };
  99. /* little merge helper - remove it after the merge window */
  100. #ifndef BUS_NOTIFY_UNBOUND_DRIVER
  101. #define BUS_NOTIFY_UNBOUND_DRIVER 0x0005
  102. #endif
  103. /*
  104. * The access to some variables in this macro is racy. We can't use atomic_t
  105. * here because all these variables are exported to debugfs. Some of them even
  106. * writeable. This is also the reason why a lock won't help much. But anyway,
  107. * the races are no big deal. Here is why:
  108. *
  109. * error_count: the addition is racy, but the worst thing that can happen is
  110. * that we don't count some errors
  111. * show_num_errors: the subtraction is racy. Also no big deal because in
  112. * worst case this will result in one warning more in the
  113. * system log than the user configured. This variable is
  114. * writeable via debugfs.
  115. */
  116. static inline void dump_entry_trace(struct dma_debug_entry *entry)
  117. {
  118. #ifdef CONFIG_STACKTRACE
  119. if (entry) {
  120. pr_warning("Mapped at:\n");
  121. print_stack_trace(&entry->stacktrace, 0);
  122. }
  123. #endif
  124. }
  125. static bool driver_filter(struct device *dev)
  126. {
  127. struct device_driver *drv;
  128. unsigned long flags;
  129. bool ret;
  130. /* driver filter off */
  131. if (likely(!current_driver_name[0]))
  132. return true;
  133. /* driver filter on and initialized */
  134. if (current_driver && dev && dev->driver == current_driver)
  135. return true;
  136. /* driver filter on, but we can't filter on a NULL device... */
  137. if (!dev)
  138. return false;
  139. if (current_driver || !current_driver_name[0])
  140. return false;
  141. /* driver filter on but not yet initialized */
  142. drv = get_driver(dev->driver);
  143. if (!drv)
  144. return false;
  145. /* lock to protect against change of current_driver_name */
  146. read_lock_irqsave(&driver_name_lock, flags);
  147. ret = false;
  148. if (drv->name &&
  149. strncmp(current_driver_name, drv->name, NAME_MAX_LEN - 1) == 0) {
  150. current_driver = drv;
  151. ret = true;
  152. }
  153. read_unlock_irqrestore(&driver_name_lock, flags);
  154. put_driver(drv);
  155. return ret;
  156. }
  157. #define err_printk(dev, entry, format, arg...) do { \
  158. error_count += 1; \
  159. if (driver_filter(dev) && \
  160. (show_all_errors || show_num_errors > 0)) { \
  161. WARN(1, "%s %s: " format, \
  162. dev ? dev_driver_string(dev) : "NULL", \
  163. dev ? dev_name(dev) : "NULL", ## arg); \
  164. dump_entry_trace(entry); \
  165. } \
  166. if (!show_all_errors && show_num_errors > 0) \
  167. show_num_errors -= 1; \
  168. } while (0);
  169. /*
  170. * Hash related functions
  171. *
  172. * Every DMA-API request is saved into a struct dma_debug_entry. To
  173. * have quick access to these structs they are stored into a hash.
  174. */
  175. static int hash_fn(struct dma_debug_entry *entry)
  176. {
  177. /*
  178. * Hash function is based on the dma address.
  179. * We use bits 20-27 here as the index into the hash
  180. */
  181. return (entry->dev_addr >> HASH_FN_SHIFT) & HASH_FN_MASK;
  182. }
  183. /*
  184. * Request exclusive access to a hash bucket for a given dma_debug_entry.
  185. */
  186. static struct hash_bucket *get_hash_bucket(struct dma_debug_entry *entry,
  187. unsigned long *flags)
  188. {
  189. int idx = hash_fn(entry);
  190. unsigned long __flags;
  191. spin_lock_irqsave(&dma_entry_hash[idx].lock, __flags);
  192. *flags = __flags;
  193. return &dma_entry_hash[idx];
  194. }
  195. /*
  196. * Give up exclusive access to the hash bucket
  197. */
  198. static void put_hash_bucket(struct hash_bucket *bucket,
  199. unsigned long *flags)
  200. {
  201. unsigned long __flags = *flags;
  202. spin_unlock_irqrestore(&bucket->lock, __flags);
  203. }
  204. /*
  205. * Search a given entry in the hash bucket list
  206. */
  207. static struct dma_debug_entry *hash_bucket_find(struct hash_bucket *bucket,
  208. struct dma_debug_entry *ref)
  209. {
  210. struct dma_debug_entry *entry, *ret = NULL;
  211. int matches = 0, match_lvl, last_lvl = 0;
  212. list_for_each_entry(entry, &bucket->list, list) {
  213. if ((entry->dev_addr != ref->dev_addr) ||
  214. (entry->dev != ref->dev))
  215. continue;
  216. /*
  217. * Some drivers map the same physical address multiple
  218. * times. Without a hardware IOMMU this results in the
  219. * same device addresses being put into the dma-debug
  220. * hash multiple times too. This can result in false
  221. * positives being reported. Therefore we implement a
  222. * best-fit algorithm here which returns the entry from
  223. * the hash which fits best to the reference value
  224. * instead of the first-fit.
  225. */
  226. matches += 1;
  227. match_lvl = 0;
  228. entry->size == ref->size ? ++match_lvl : 0;
  229. entry->type == ref->type ? ++match_lvl : 0;
  230. entry->direction == ref->direction ? ++match_lvl : 0;
  231. entry->sg_call_ents == ref->sg_call_ents ? ++match_lvl : 0;
  232. if (match_lvl == 4) {
  233. /* perfect-fit - return the result */
  234. return entry;
  235. } else if (match_lvl > last_lvl) {
  236. /*
  237. * We found an entry that fits better then the
  238. * previous one
  239. */
  240. last_lvl = match_lvl;
  241. ret = entry;
  242. }
  243. }
  244. /*
  245. * If we have multiple matches but no perfect-fit, just return
  246. * NULL.
  247. */
  248. ret = (matches == 1) ? ret : NULL;
  249. return ret;
  250. }
  251. /*
  252. * Add an entry to a hash bucket
  253. */
  254. static void hash_bucket_add(struct hash_bucket *bucket,
  255. struct dma_debug_entry *entry)
  256. {
  257. list_add_tail(&entry->list, &bucket->list);
  258. }
  259. /*
  260. * Remove entry from a hash bucket list
  261. */
  262. static void hash_bucket_del(struct dma_debug_entry *entry)
  263. {
  264. list_del(&entry->list);
  265. }
  266. /*
  267. * Dump mapping entries for debugging purposes
  268. */
  269. void debug_dma_dump_mappings(struct device *dev)
  270. {
  271. int idx;
  272. for (idx = 0; idx < HASH_SIZE; idx++) {
  273. struct hash_bucket *bucket = &dma_entry_hash[idx];
  274. struct dma_debug_entry *entry;
  275. unsigned long flags;
  276. spin_lock_irqsave(&bucket->lock, flags);
  277. list_for_each_entry(entry, &bucket->list, list) {
  278. if (!dev || dev == entry->dev) {
  279. dev_info(entry->dev,
  280. "%s idx %d P=%Lx D=%Lx L=%Lx %s\n",
  281. type2name[entry->type], idx,
  282. (unsigned long long)entry->paddr,
  283. entry->dev_addr, entry->size,
  284. dir2name[entry->direction]);
  285. }
  286. }
  287. spin_unlock_irqrestore(&bucket->lock, flags);
  288. }
  289. }
  290. EXPORT_SYMBOL(debug_dma_dump_mappings);
  291. /*
  292. * Wrapper function for adding an entry to the hash.
  293. * This function takes care of locking itself.
  294. */
  295. static void add_dma_entry(struct dma_debug_entry *entry)
  296. {
  297. struct hash_bucket *bucket;
  298. unsigned long flags;
  299. bucket = get_hash_bucket(entry, &flags);
  300. hash_bucket_add(bucket, entry);
  301. put_hash_bucket(bucket, &flags);
  302. }
  303. static struct dma_debug_entry *__dma_entry_alloc(void)
  304. {
  305. struct dma_debug_entry *entry;
  306. entry = list_entry(free_entries.next, struct dma_debug_entry, list);
  307. list_del(&entry->list);
  308. memset(entry, 0, sizeof(*entry));
  309. num_free_entries -= 1;
  310. if (num_free_entries < min_free_entries)
  311. min_free_entries = num_free_entries;
  312. return entry;
  313. }
  314. /* struct dma_entry allocator
  315. *
  316. * The next two functions implement the allocator for
  317. * struct dma_debug_entries.
  318. */
  319. static struct dma_debug_entry *dma_entry_alloc(void)
  320. {
  321. struct dma_debug_entry *entry = NULL;
  322. unsigned long flags;
  323. spin_lock_irqsave(&free_entries_lock, flags);
  324. if (list_empty(&free_entries)) {
  325. pr_err("DMA-API: debugging out of memory - disabling\n");
  326. global_disable = true;
  327. goto out;
  328. }
  329. entry = __dma_entry_alloc();
  330. #ifdef CONFIG_STACKTRACE
  331. entry->stacktrace.max_entries = DMA_DEBUG_STACKTRACE_ENTRIES;
  332. entry->stacktrace.entries = entry->st_entries;
  333. entry->stacktrace.skip = 2;
  334. save_stack_trace(&entry->stacktrace);
  335. #endif
  336. out:
  337. spin_unlock_irqrestore(&free_entries_lock, flags);
  338. return entry;
  339. }
  340. static void dma_entry_free(struct dma_debug_entry *entry)
  341. {
  342. unsigned long flags;
  343. /*
  344. * add to beginning of the list - this way the entries are
  345. * more likely cache hot when they are reallocated.
  346. */
  347. spin_lock_irqsave(&free_entries_lock, flags);
  348. list_add(&entry->list, &free_entries);
  349. num_free_entries += 1;
  350. spin_unlock_irqrestore(&free_entries_lock, flags);
  351. }
  352. int dma_debug_resize_entries(u32 num_entries)
  353. {
  354. int i, delta, ret = 0;
  355. unsigned long flags;
  356. struct dma_debug_entry *entry;
  357. LIST_HEAD(tmp);
  358. spin_lock_irqsave(&free_entries_lock, flags);
  359. if (nr_total_entries < num_entries) {
  360. delta = num_entries - nr_total_entries;
  361. spin_unlock_irqrestore(&free_entries_lock, flags);
  362. for (i = 0; i < delta; i++) {
  363. entry = kzalloc(sizeof(*entry), GFP_KERNEL);
  364. if (!entry)
  365. break;
  366. list_add_tail(&entry->list, &tmp);
  367. }
  368. spin_lock_irqsave(&free_entries_lock, flags);
  369. list_splice(&tmp, &free_entries);
  370. nr_total_entries += i;
  371. num_free_entries += i;
  372. } else {
  373. delta = nr_total_entries - num_entries;
  374. for (i = 0; i < delta && !list_empty(&free_entries); i++) {
  375. entry = __dma_entry_alloc();
  376. kfree(entry);
  377. }
  378. nr_total_entries -= i;
  379. }
  380. if (nr_total_entries != num_entries)
  381. ret = 1;
  382. spin_unlock_irqrestore(&free_entries_lock, flags);
  383. return ret;
  384. }
  385. EXPORT_SYMBOL(dma_debug_resize_entries);
  386. /*
  387. * DMA-API debugging init code
  388. *
  389. * The init code does two things:
  390. * 1. Initialize core data structures
  391. * 2. Preallocate a given number of dma_debug_entry structs
  392. */
  393. static int prealloc_memory(u32 num_entries)
  394. {
  395. struct dma_debug_entry *entry, *next_entry;
  396. int i;
  397. for (i = 0; i < num_entries; ++i) {
  398. entry = kzalloc(sizeof(*entry), GFP_KERNEL);
  399. if (!entry)
  400. goto out_err;
  401. list_add_tail(&entry->list, &free_entries);
  402. }
  403. num_free_entries = num_entries;
  404. min_free_entries = num_entries;
  405. pr_info("DMA-API: preallocated %d debug entries\n", num_entries);
  406. return 0;
  407. out_err:
  408. list_for_each_entry_safe(entry, next_entry, &free_entries, list) {
  409. list_del(&entry->list);
  410. kfree(entry);
  411. }
  412. return -ENOMEM;
  413. }
  414. static ssize_t filter_read(struct file *file, char __user *user_buf,
  415. size_t count, loff_t *ppos)
  416. {
  417. char buf[NAME_MAX_LEN + 1];
  418. unsigned long flags;
  419. int len;
  420. if (!current_driver_name[0])
  421. return 0;
  422. /*
  423. * We can't copy to userspace directly because current_driver_name can
  424. * only be read under the driver_name_lock with irqs disabled. So
  425. * create a temporary copy first.
  426. */
  427. read_lock_irqsave(&driver_name_lock, flags);
  428. len = scnprintf(buf, NAME_MAX_LEN + 1, "%s\n", current_driver_name);
  429. read_unlock_irqrestore(&driver_name_lock, flags);
  430. return simple_read_from_buffer(user_buf, count, ppos, buf, len);
  431. }
  432. static ssize_t filter_write(struct file *file, const char __user *userbuf,
  433. size_t count, loff_t *ppos)
  434. {
  435. char buf[NAME_MAX_LEN];
  436. unsigned long flags;
  437. size_t len;
  438. int i;
  439. /*
  440. * We can't copy from userspace directly. Access to
  441. * current_driver_name is protected with a write_lock with irqs
  442. * disabled. Since copy_from_user can fault and may sleep we
  443. * need to copy to temporary buffer first
  444. */
  445. len = min(count, (size_t)(NAME_MAX_LEN - 1));
  446. if (copy_from_user(buf, userbuf, len))
  447. return -EFAULT;
  448. buf[len] = 0;
  449. write_lock_irqsave(&driver_name_lock, flags);
  450. /*
  451. * Now handle the string we got from userspace very carefully.
  452. * The rules are:
  453. * - only use the first token we got
  454. * - token delimiter is everything looking like a space
  455. * character (' ', '\n', '\t' ...)
  456. *
  457. */
  458. if (!isalnum(buf[0])) {
  459. /*
  460. * If the first character userspace gave us is not
  461. * alphanumerical then assume the filter should be
  462. * switched off.
  463. */
  464. if (current_driver_name[0])
  465. pr_info("DMA-API: switching off dma-debug driver filter\n");
  466. current_driver_name[0] = 0;
  467. current_driver = NULL;
  468. goto out_unlock;
  469. }
  470. /*
  471. * Now parse out the first token and use it as the name for the
  472. * driver to filter for.
  473. */
  474. for (i = 0; i < NAME_MAX_LEN - 1; ++i) {
  475. current_driver_name[i] = buf[i];
  476. if (isspace(buf[i]) || buf[i] == ' ' || buf[i] == 0)
  477. break;
  478. }
  479. current_driver_name[i] = 0;
  480. current_driver = NULL;
  481. pr_info("DMA-API: enable driver filter for driver [%s]\n",
  482. current_driver_name);
  483. out_unlock:
  484. write_unlock_irqrestore(&driver_name_lock, flags);
  485. return count;
  486. }
  487. static const struct file_operations filter_fops = {
  488. .read = filter_read,
  489. .write = filter_write,
  490. .llseek = default_llseek,
  491. };
  492. static int dma_debug_fs_init(void)
  493. {
  494. dma_debug_dent = debugfs_create_dir("dma-api", NULL);
  495. if (!dma_debug_dent) {
  496. pr_err("DMA-API: can not create debugfs directory\n");
  497. return -ENOMEM;
  498. }
  499. global_disable_dent = debugfs_create_bool("disabled", 0444,
  500. dma_debug_dent,
  501. (u32 *)&global_disable);
  502. if (!global_disable_dent)
  503. goto out_err;
  504. error_count_dent = debugfs_create_u32("error_count", 0444,
  505. dma_debug_dent, &error_count);
  506. if (!error_count_dent)
  507. goto out_err;
  508. show_all_errors_dent = debugfs_create_u32("all_errors", 0644,
  509. dma_debug_dent,
  510. &show_all_errors);
  511. if (!show_all_errors_dent)
  512. goto out_err;
  513. show_num_errors_dent = debugfs_create_u32("num_errors", 0644,
  514. dma_debug_dent,
  515. &show_num_errors);
  516. if (!show_num_errors_dent)
  517. goto out_err;
  518. num_free_entries_dent = debugfs_create_u32("num_free_entries", 0444,
  519. dma_debug_dent,
  520. &num_free_entries);
  521. if (!num_free_entries_dent)
  522. goto out_err;
  523. min_free_entries_dent = debugfs_create_u32("min_free_entries", 0444,
  524. dma_debug_dent,
  525. &min_free_entries);
  526. if (!min_free_entries_dent)
  527. goto out_err;
  528. filter_dent = debugfs_create_file("driver_filter", 0644,
  529. dma_debug_dent, NULL, &filter_fops);
  530. if (!filter_dent)
  531. goto out_err;
  532. return 0;
  533. out_err:
  534. debugfs_remove_recursive(dma_debug_dent);
  535. return -ENOMEM;
  536. }
  537. static int device_dma_allocations(struct device *dev)
  538. {
  539. struct dma_debug_entry *entry;
  540. unsigned long flags;
  541. int count = 0, i;
  542. local_irq_save(flags);
  543. for (i = 0; i < HASH_SIZE; ++i) {
  544. spin_lock(&dma_entry_hash[i].lock);
  545. list_for_each_entry(entry, &dma_entry_hash[i].list, list) {
  546. if (entry->dev == dev)
  547. count += 1;
  548. }
  549. spin_unlock(&dma_entry_hash[i].lock);
  550. }
  551. local_irq_restore(flags);
  552. return count;
  553. }
  554. static int dma_debug_device_change(struct notifier_block *nb, unsigned long action, void *data)
  555. {
  556. struct device *dev = data;
  557. int count;
  558. if (global_disable)
  559. return 0;
  560. switch (action) {
  561. case BUS_NOTIFY_UNBOUND_DRIVER:
  562. count = device_dma_allocations(dev);
  563. if (count == 0)
  564. break;
  565. err_printk(dev, NULL, "DMA-API: device driver has pending "
  566. "DMA allocations while released from device "
  567. "[count=%d]\n", count);
  568. break;
  569. default:
  570. break;
  571. }
  572. return 0;
  573. }
  574. void dma_debug_add_bus(struct bus_type *bus)
  575. {
  576. struct notifier_block *nb;
  577. if (global_disable)
  578. return;
  579. nb = kzalloc(sizeof(struct notifier_block), GFP_KERNEL);
  580. if (nb == NULL) {
  581. pr_err("dma_debug_add_bus: out of memory\n");
  582. return;
  583. }
  584. nb->notifier_call = dma_debug_device_change;
  585. bus_register_notifier(bus, nb);
  586. }
  587. /*
  588. * Let the architectures decide how many entries should be preallocated.
  589. */
  590. void dma_debug_init(u32 num_entries)
  591. {
  592. int i;
  593. if (global_disable)
  594. return;
  595. for (i = 0; i < HASH_SIZE; ++i) {
  596. INIT_LIST_HEAD(&dma_entry_hash[i].list);
  597. spin_lock_init(&dma_entry_hash[i].lock);
  598. }
  599. if (dma_debug_fs_init() != 0) {
  600. pr_err("DMA-API: error creating debugfs entries - disabling\n");
  601. global_disable = true;
  602. return;
  603. }
  604. if (req_entries)
  605. num_entries = req_entries;
  606. if (prealloc_memory(num_entries) != 0) {
  607. pr_err("DMA-API: debugging out of memory error - disabled\n");
  608. global_disable = true;
  609. return;
  610. }
  611. nr_total_entries = num_free_entries;
  612. pr_info("DMA-API: debugging enabled by kernel config\n");
  613. }
  614. static __init int dma_debug_cmdline(char *str)
  615. {
  616. if (!str)
  617. return -EINVAL;
  618. if (strncmp(str, "off", 3) == 0) {
  619. pr_info("DMA-API: debugging disabled on kernel command line\n");
  620. global_disable = true;
  621. }
  622. return 0;
  623. }
  624. static __init int dma_debug_entries_cmdline(char *str)
  625. {
  626. int res;
  627. if (!str)
  628. return -EINVAL;
  629. res = get_option(&str, &req_entries);
  630. if (!res)
  631. req_entries = 0;
  632. return 0;
  633. }
  634. __setup("dma_debug=", dma_debug_cmdline);
  635. __setup("dma_debug_entries=", dma_debug_entries_cmdline);
  636. static void check_unmap(struct dma_debug_entry *ref)
  637. {
  638. struct dma_debug_entry *entry;
  639. struct hash_bucket *bucket;
  640. unsigned long flags;
  641. if (dma_mapping_error(ref->dev, ref->dev_addr)) {
  642. err_printk(ref->dev, NULL, "DMA-API: device driver tries "
  643. "to free an invalid DMA memory address\n");
  644. return;
  645. }
  646. bucket = get_hash_bucket(ref, &flags);
  647. entry = hash_bucket_find(bucket, ref);
  648. if (!entry) {
  649. err_printk(ref->dev, NULL, "DMA-API: device driver tries "
  650. "to free DMA memory it has not allocated "
  651. "[device address=0x%016llx] [size=%llu bytes]\n",
  652. ref->dev_addr, ref->size);
  653. goto out;
  654. }
  655. if (ref->size != entry->size) {
  656. err_printk(ref->dev, entry, "DMA-API: device driver frees "
  657. "DMA memory with different size "
  658. "[device address=0x%016llx] [map size=%llu bytes] "
  659. "[unmap size=%llu bytes]\n",
  660. ref->dev_addr, entry->size, ref->size);
  661. }
  662. if (ref->type != entry->type) {
  663. err_printk(ref->dev, entry, "DMA-API: device driver frees "
  664. "DMA memory with wrong function "
  665. "[device address=0x%016llx] [size=%llu bytes] "
  666. "[mapped as %s] [unmapped as %s]\n",
  667. ref->dev_addr, ref->size,
  668. type2name[entry->type], type2name[ref->type]);
  669. } else if ((entry->type == dma_debug_coherent) &&
  670. (ref->paddr != entry->paddr)) {
  671. err_printk(ref->dev, entry, "DMA-API: device driver frees "
  672. "DMA memory with different CPU address "
  673. "[device address=0x%016llx] [size=%llu bytes] "
  674. "[cpu alloc address=0x%016llx] "
  675. "[cpu free address=0x%016llx]",
  676. ref->dev_addr, ref->size,
  677. (unsigned long long)entry->paddr,
  678. (unsigned long long)ref->paddr);
  679. }
  680. if (ref->sg_call_ents && ref->type == dma_debug_sg &&
  681. ref->sg_call_ents != entry->sg_call_ents) {
  682. err_printk(ref->dev, entry, "DMA-API: device driver frees "
  683. "DMA sg list with different entry count "
  684. "[map count=%d] [unmap count=%d]\n",
  685. entry->sg_call_ents, ref->sg_call_ents);
  686. }
  687. /*
  688. * This may be no bug in reality - but most implementations of the
  689. * DMA API don't handle this properly, so check for it here
  690. */
  691. if (ref->direction != entry->direction) {
  692. err_printk(ref->dev, entry, "DMA-API: device driver frees "
  693. "DMA memory with different direction "
  694. "[device address=0x%016llx] [size=%llu bytes] "
  695. "[mapped with %s] [unmapped with %s]\n",
  696. ref->dev_addr, ref->size,
  697. dir2name[entry->direction],
  698. dir2name[ref->direction]);
  699. }
  700. hash_bucket_del(entry);
  701. dma_entry_free(entry);
  702. out:
  703. put_hash_bucket(bucket, &flags);
  704. }
  705. static void check_for_stack(struct device *dev, void *addr)
  706. {
  707. if (object_is_on_stack(addr))
  708. err_printk(dev, NULL, "DMA-API: device driver maps memory from"
  709. "stack [addr=%p]\n", addr);
  710. }
  711. static inline bool overlap(void *addr, unsigned long len, void *start, void *end)
  712. {
  713. unsigned long a1 = (unsigned long)addr;
  714. unsigned long b1 = a1 + len;
  715. unsigned long a2 = (unsigned long)start;
  716. unsigned long b2 = (unsigned long)end;
  717. return !(b1 <= a2 || a1 >= b2);
  718. }
  719. static void check_for_illegal_area(struct device *dev, void *addr, unsigned long len)
  720. {
  721. if (overlap(addr, len, _text, _etext) ||
  722. overlap(addr, len, __start_rodata, __end_rodata))
  723. err_printk(dev, NULL, "DMA-API: device driver maps memory from kernel text or rodata [addr=%p] [len=%lu]\n", addr, len);
  724. }
  725. static void check_sync(struct device *dev,
  726. struct dma_debug_entry *ref,
  727. bool to_cpu)
  728. {
  729. struct dma_debug_entry *entry;
  730. struct hash_bucket *bucket;
  731. unsigned long flags;
  732. bucket = get_hash_bucket(ref, &flags);
  733. entry = hash_bucket_find(bucket, ref);
  734. if (!entry) {
  735. err_printk(dev, NULL, "DMA-API: device driver tries "
  736. "to sync DMA memory it has not allocated "
  737. "[device address=0x%016llx] [size=%llu bytes]\n",
  738. (unsigned long long)ref->dev_addr, ref->size);
  739. goto out;
  740. }
  741. if (ref->size > entry->size) {
  742. err_printk(dev, entry, "DMA-API: device driver syncs"
  743. " DMA memory outside allocated range "
  744. "[device address=0x%016llx] "
  745. "[allocation size=%llu bytes] "
  746. "[sync offset+size=%llu]\n",
  747. entry->dev_addr, entry->size,
  748. ref->size);
  749. }
  750. if (entry->direction == DMA_BIDIRECTIONAL)
  751. goto out;
  752. if (ref->direction != entry->direction) {
  753. err_printk(dev, entry, "DMA-API: device driver syncs "
  754. "DMA memory with different direction "
  755. "[device address=0x%016llx] [size=%llu bytes] "
  756. "[mapped with %s] [synced with %s]\n",
  757. (unsigned long long)ref->dev_addr, entry->size,
  758. dir2name[entry->direction],
  759. dir2name[ref->direction]);
  760. }
  761. if (to_cpu && !(entry->direction == DMA_FROM_DEVICE) &&
  762. !(ref->direction == DMA_TO_DEVICE))
  763. err_printk(dev, entry, "DMA-API: device driver syncs "
  764. "device read-only DMA memory for cpu "
  765. "[device address=0x%016llx] [size=%llu bytes] "
  766. "[mapped with %s] [synced with %s]\n",
  767. (unsigned long long)ref->dev_addr, entry->size,
  768. dir2name[entry->direction],
  769. dir2name[ref->direction]);
  770. if (!to_cpu && !(entry->direction == DMA_TO_DEVICE) &&
  771. !(ref->direction == DMA_FROM_DEVICE))
  772. err_printk(dev, entry, "DMA-API: device driver syncs "
  773. "device write-only DMA memory to device "
  774. "[device address=0x%016llx] [size=%llu bytes] "
  775. "[mapped with %s] [synced with %s]\n",
  776. (unsigned long long)ref->dev_addr, entry->size,
  777. dir2name[entry->direction],
  778. dir2name[ref->direction]);
  779. out:
  780. put_hash_bucket(bucket, &flags);
  781. }
  782. void debug_dma_map_page(struct device *dev, struct page *page, size_t offset,
  783. size_t size, int direction, dma_addr_t dma_addr,
  784. bool map_single)
  785. {
  786. struct dma_debug_entry *entry;
  787. if (unlikely(global_disable))
  788. return;
  789. if (unlikely(dma_mapping_error(dev, dma_addr)))
  790. return;
  791. entry = dma_entry_alloc();
  792. if (!entry)
  793. return;
  794. entry->dev = dev;
  795. entry->type = dma_debug_page;
  796. entry->paddr = page_to_phys(page) + offset;
  797. entry->dev_addr = dma_addr;
  798. entry->size = size;
  799. entry->direction = direction;
  800. if (map_single)
  801. entry->type = dma_debug_single;
  802. if (!PageHighMem(page)) {
  803. void *addr = page_address(page) + offset;
  804. check_for_stack(dev, addr);
  805. check_for_illegal_area(dev, addr, size);
  806. }
  807. add_dma_entry(entry);
  808. }
  809. EXPORT_SYMBOL(debug_dma_map_page);
  810. void debug_dma_unmap_page(struct device *dev, dma_addr_t addr,
  811. size_t size, int direction, bool map_single)
  812. {
  813. struct dma_debug_entry ref = {
  814. .type = dma_debug_page,
  815. .dev = dev,
  816. .dev_addr = addr,
  817. .size = size,
  818. .direction = direction,
  819. };
  820. if (unlikely(global_disable))
  821. return;
  822. if (map_single)
  823. ref.type = dma_debug_single;
  824. check_unmap(&ref);
  825. }
  826. EXPORT_SYMBOL(debug_dma_unmap_page);
  827. void debug_dma_map_sg(struct device *dev, struct scatterlist *sg,
  828. int nents, int mapped_ents, int direction)
  829. {
  830. struct dma_debug_entry *entry;
  831. struct scatterlist *s;
  832. int i;
  833. if (unlikely(global_disable))
  834. return;
  835. for_each_sg(sg, s, mapped_ents, i) {
  836. entry = dma_entry_alloc();
  837. if (!entry)
  838. return;
  839. entry->type = dma_debug_sg;
  840. entry->dev = dev;
  841. entry->paddr = sg_phys(s);
  842. entry->size = sg_dma_len(s);
  843. entry->dev_addr = sg_dma_address(s);
  844. entry->direction = direction;
  845. entry->sg_call_ents = nents;
  846. entry->sg_mapped_ents = mapped_ents;
  847. if (!PageHighMem(sg_page(s))) {
  848. check_for_stack(dev, sg_virt(s));
  849. check_for_illegal_area(dev, sg_virt(s), sg_dma_len(s));
  850. }
  851. add_dma_entry(entry);
  852. }
  853. }
  854. EXPORT_SYMBOL(debug_dma_map_sg);
  855. static int get_nr_mapped_entries(struct device *dev,
  856. struct dma_debug_entry *ref)
  857. {
  858. struct dma_debug_entry *entry;
  859. struct hash_bucket *bucket;
  860. unsigned long flags;
  861. int mapped_ents;
  862. bucket = get_hash_bucket(ref, &flags);
  863. entry = hash_bucket_find(bucket, ref);
  864. mapped_ents = 0;
  865. if (entry)
  866. mapped_ents = entry->sg_mapped_ents;
  867. put_hash_bucket(bucket, &flags);
  868. return mapped_ents;
  869. }
  870. void debug_dma_unmap_sg(struct device *dev, struct scatterlist *sglist,
  871. int nelems, int dir)
  872. {
  873. struct scatterlist *s;
  874. int mapped_ents = 0, i;
  875. if (unlikely(global_disable))
  876. return;
  877. for_each_sg(sglist, s, nelems, i) {
  878. struct dma_debug_entry ref = {
  879. .type = dma_debug_sg,
  880. .dev = dev,
  881. .paddr = sg_phys(s),
  882. .dev_addr = sg_dma_address(s),
  883. .size = sg_dma_len(s),
  884. .direction = dir,
  885. .sg_call_ents = nelems,
  886. };
  887. if (mapped_ents && i >= mapped_ents)
  888. break;
  889. if (!i)
  890. mapped_ents = get_nr_mapped_entries(dev, &ref);
  891. check_unmap(&ref);
  892. }
  893. }
  894. EXPORT_SYMBOL(debug_dma_unmap_sg);
  895. void debug_dma_alloc_coherent(struct device *dev, size_t size,
  896. dma_addr_t dma_addr, void *virt)
  897. {
  898. struct dma_debug_entry *entry;
  899. if (unlikely(global_disable))
  900. return;
  901. if (unlikely(virt == NULL))
  902. return;
  903. entry = dma_entry_alloc();
  904. if (!entry)
  905. return;
  906. entry->type = dma_debug_coherent;
  907. entry->dev = dev;
  908. entry->paddr = virt_to_phys(virt);
  909. entry->size = size;
  910. entry->dev_addr = dma_addr;
  911. entry->direction = DMA_BIDIRECTIONAL;
  912. add_dma_entry(entry);
  913. }
  914. EXPORT_SYMBOL(debug_dma_alloc_coherent);
  915. void debug_dma_free_coherent(struct device *dev, size_t size,
  916. void *virt, dma_addr_t addr)
  917. {
  918. struct dma_debug_entry ref = {
  919. .type = dma_debug_coherent,
  920. .dev = dev,
  921. .paddr = virt_to_phys(virt),
  922. .dev_addr = addr,
  923. .size = size,
  924. .direction = DMA_BIDIRECTIONAL,
  925. };
  926. if (unlikely(global_disable))
  927. return;
  928. check_unmap(&ref);
  929. }
  930. EXPORT_SYMBOL(debug_dma_free_coherent);
  931. void debug_dma_sync_single_for_cpu(struct device *dev, dma_addr_t dma_handle,
  932. size_t size, int direction)
  933. {
  934. struct dma_debug_entry ref;
  935. if (unlikely(global_disable))
  936. return;
  937. ref.type = dma_debug_single;
  938. ref.dev = dev;
  939. ref.dev_addr = dma_handle;
  940. ref.size = size;
  941. ref.direction = direction;
  942. ref.sg_call_ents = 0;
  943. check_sync(dev, &ref, true);
  944. }
  945. EXPORT_SYMBOL(debug_dma_sync_single_for_cpu);
  946. void debug_dma_sync_single_for_device(struct device *dev,
  947. dma_addr_t dma_handle, size_t size,
  948. int direction)
  949. {
  950. struct dma_debug_entry ref;
  951. if (unlikely(global_disable))
  952. return;
  953. ref.type = dma_debug_single;
  954. ref.dev = dev;
  955. ref.dev_addr = dma_handle;
  956. ref.size = size;
  957. ref.direction = direction;
  958. ref.sg_call_ents = 0;
  959. check_sync(dev, &ref, false);
  960. }
  961. EXPORT_SYMBOL(debug_dma_sync_single_for_device);
  962. void debug_dma_sync_single_range_for_cpu(struct device *dev,
  963. dma_addr_t dma_handle,
  964. unsigned long offset, size_t size,
  965. int direction)
  966. {
  967. struct dma_debug_entry ref;
  968. if (unlikely(global_disable))
  969. return;
  970. ref.type = dma_debug_single;
  971. ref.dev = dev;
  972. ref.dev_addr = dma_handle;
  973. ref.size = offset + size;
  974. ref.direction = direction;
  975. ref.sg_call_ents = 0;
  976. check_sync(dev, &ref, true);
  977. }
  978. EXPORT_SYMBOL(debug_dma_sync_single_range_for_cpu);
  979. void debug_dma_sync_single_range_for_device(struct device *dev,
  980. dma_addr_t dma_handle,
  981. unsigned long offset,
  982. size_t size, int direction)
  983. {
  984. struct dma_debug_entry ref;
  985. if (unlikely(global_disable))
  986. return;
  987. ref.type = dma_debug_single;
  988. ref.dev = dev;
  989. ref.dev_addr = dma_handle;
  990. ref.size = offset + size;
  991. ref.direction = direction;
  992. ref.sg_call_ents = 0;
  993. check_sync(dev, &ref, false);
  994. }
  995. EXPORT_SYMBOL(debug_dma_sync_single_range_for_device);
  996. void debug_dma_sync_sg_for_cpu(struct device *dev, struct scatterlist *sg,
  997. int nelems, int direction)
  998. {
  999. struct scatterlist *s;
  1000. int mapped_ents = 0, i;
  1001. if (unlikely(global_disable))
  1002. return;
  1003. for_each_sg(sg, s, nelems, i) {
  1004. struct dma_debug_entry ref = {
  1005. .type = dma_debug_sg,
  1006. .dev = dev,
  1007. .paddr = sg_phys(s),
  1008. .dev_addr = sg_dma_address(s),
  1009. .size = sg_dma_len(s),
  1010. .direction = direction,
  1011. .sg_call_ents = nelems,
  1012. };
  1013. if (!i)
  1014. mapped_ents = get_nr_mapped_entries(dev, &ref);
  1015. if (i >= mapped_ents)
  1016. break;
  1017. check_sync(dev, &ref, true);
  1018. }
  1019. }
  1020. EXPORT_SYMBOL(debug_dma_sync_sg_for_cpu);
  1021. void debug_dma_sync_sg_for_device(struct device *dev, struct scatterlist *sg,
  1022. int nelems, int direction)
  1023. {
  1024. struct scatterlist *s;
  1025. int mapped_ents = 0, i;
  1026. if (unlikely(global_disable))
  1027. return;
  1028. for_each_sg(sg, s, nelems, i) {
  1029. struct dma_debug_entry ref = {
  1030. .type = dma_debug_sg,
  1031. .dev = dev,
  1032. .paddr = sg_phys(s),
  1033. .dev_addr = sg_dma_address(s),
  1034. .size = sg_dma_len(s),
  1035. .direction = direction,
  1036. .sg_call_ents = nelems,
  1037. };
  1038. if (!i)
  1039. mapped_ents = get_nr_mapped_entries(dev, &ref);
  1040. if (i >= mapped_ents)
  1041. break;
  1042. check_sync(dev, &ref, false);
  1043. }
  1044. }
  1045. EXPORT_SYMBOL(debug_dma_sync_sg_for_device);
  1046. static int __init dma_debug_driver_setup(char *str)
  1047. {
  1048. int i;
  1049. for (i = 0; i < NAME_MAX_LEN - 1; ++i, ++str) {
  1050. current_driver_name[i] = *str;
  1051. if (*str == 0)
  1052. break;
  1053. }
  1054. if (current_driver_name[0])
  1055. pr_info("DMA-API: enable driver filter for driver [%s]\n",
  1056. current_driver_name);
  1057. return 1;
  1058. }
  1059. __setup("dma_debug_driver=", dma_debug_driver_setup);