dma-debug.c 33 KB

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