dma-debug.c 32 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304
  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; ++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. };
  491. static int dma_debug_fs_init(void)
  492. {
  493. dma_debug_dent = debugfs_create_dir("dma-api", NULL);
  494. if (!dma_debug_dent) {
  495. pr_err("DMA-API: can not create debugfs directory\n");
  496. return -ENOMEM;
  497. }
  498. global_disable_dent = debugfs_create_bool("disabled", 0444,
  499. dma_debug_dent,
  500. (u32 *)&global_disable);
  501. if (!global_disable_dent)
  502. goto out_err;
  503. error_count_dent = debugfs_create_u32("error_count", 0444,
  504. dma_debug_dent, &error_count);
  505. if (!error_count_dent)
  506. goto out_err;
  507. show_all_errors_dent = debugfs_create_u32("all_errors", 0644,
  508. dma_debug_dent,
  509. &show_all_errors);
  510. if (!show_all_errors_dent)
  511. goto out_err;
  512. show_num_errors_dent = debugfs_create_u32("num_errors", 0644,
  513. dma_debug_dent,
  514. &show_num_errors);
  515. if (!show_num_errors_dent)
  516. goto out_err;
  517. num_free_entries_dent = debugfs_create_u32("num_free_entries", 0444,
  518. dma_debug_dent,
  519. &num_free_entries);
  520. if (!num_free_entries_dent)
  521. goto out_err;
  522. min_free_entries_dent = debugfs_create_u32("min_free_entries", 0444,
  523. dma_debug_dent,
  524. &min_free_entries);
  525. if (!min_free_entries_dent)
  526. goto out_err;
  527. filter_dent = debugfs_create_file("driver_filter", 0644,
  528. dma_debug_dent, NULL, &filter_fops);
  529. if (!filter_dent)
  530. goto out_err;
  531. return 0;
  532. out_err:
  533. debugfs_remove_recursive(dma_debug_dent);
  534. return -ENOMEM;
  535. }
  536. static int device_dma_allocations(struct device *dev)
  537. {
  538. struct dma_debug_entry *entry;
  539. unsigned long flags;
  540. int count = 0, i;
  541. local_irq_save(flags);
  542. for (i = 0; i < HASH_SIZE; ++i) {
  543. spin_lock(&dma_entry_hash[i].lock);
  544. list_for_each_entry(entry, &dma_entry_hash[i].list, list) {
  545. if (entry->dev == dev)
  546. count += 1;
  547. }
  548. spin_unlock(&dma_entry_hash[i].lock);
  549. }
  550. local_irq_restore(flags);
  551. return count;
  552. }
  553. static int dma_debug_device_change(struct notifier_block *nb,
  554. unsigned long action, void *data)
  555. {
  556. struct device *dev = data;
  557. int count;
  558. if (global_disable)
  559. return;
  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 (ref->direction != entry->direction) {
  751. err_printk(dev, entry, "DMA-API: device driver syncs "
  752. "DMA memory with different direction "
  753. "[device address=0x%016llx] [size=%llu bytes] "
  754. "[mapped with %s] [synced with %s]\n",
  755. (unsigned long long)ref->dev_addr, entry->size,
  756. dir2name[entry->direction],
  757. dir2name[ref->direction]);
  758. }
  759. if (entry->direction == DMA_BIDIRECTIONAL)
  760. goto out;
  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);