| Konrad Rzeszutek Wilk | 5bef80a | 2010-08-26 13:57:58 -0400 | [diff] [blame] | 1 | #include <linux/dma-mapping.h> | 
|  | 2 | #include <asm/iommu_table.h> | 
|  | 3 | #include <linux/string.h> | 
|  | 4 | #include <linux/kallsyms.h> | 
|  | 5 |  | 
|  | 6 |  | 
|  | 7 | #define DEBUG 1 | 
|  | 8 |  | 
|  | 9 | static struct iommu_table_entry * __init | 
|  | 10 | find_dependents_of(struct iommu_table_entry *start, | 
|  | 11 | struct iommu_table_entry *finish, | 
|  | 12 | struct iommu_table_entry *q) | 
|  | 13 | { | 
|  | 14 | struct iommu_table_entry *p; | 
|  | 15 |  | 
|  | 16 | if (!q) | 
|  | 17 | return NULL; | 
|  | 18 |  | 
|  | 19 | for (p = start; p < finish; p++) | 
|  | 20 | if (p->detect == q->depend) | 
|  | 21 | return p; | 
|  | 22 |  | 
|  | 23 | return NULL; | 
|  | 24 | } | 
|  | 25 |  | 
|  | 26 |  | 
|  | 27 | void __init sort_iommu_table(struct iommu_table_entry *start, | 
|  | 28 | struct iommu_table_entry *finish) { | 
|  | 29 |  | 
|  | 30 | struct iommu_table_entry *p, *q, tmp; | 
|  | 31 |  | 
|  | 32 | for (p = start; p < finish; p++) { | 
|  | 33 | again: | 
|  | 34 | q = find_dependents_of(start, finish, p); | 
|  | 35 | /* We are bit sneaky here. We use the memory address to figure | 
|  | 36 | * out if the node we depend on is past our point, if so, swap. | 
|  | 37 | */ | 
|  | 38 | if (q > p) { | 
|  | 39 | tmp = *p; | 
|  | 40 | memmove(p, q, sizeof(*p)); | 
|  | 41 | *q = tmp; | 
|  | 42 | goto again; | 
|  | 43 | } | 
|  | 44 | } | 
|  | 45 |  | 
|  | 46 | } | 
|  | 47 |  | 
|  | 48 | #ifdef DEBUG | 
|  | 49 | void __init check_iommu_entries(struct iommu_table_entry *start, | 
|  | 50 | struct iommu_table_entry *finish) | 
|  | 51 | { | 
|  | 52 | struct iommu_table_entry *p, *q, *x; | 
|  | 53 | char sym_p[KSYM_SYMBOL_LEN]; | 
|  | 54 | char sym_q[KSYM_SYMBOL_LEN]; | 
|  | 55 |  | 
|  | 56 | /* Simple cyclic dependency checker. */ | 
|  | 57 | for (p = start; p < finish; p++) { | 
|  | 58 | q = find_dependents_of(start, finish, p); | 
|  | 59 | x = find_dependents_of(start, finish, q); | 
|  | 60 | if (p == x) { | 
|  | 61 | sprint_symbol(sym_p, (unsigned long)p->detect); | 
|  | 62 | sprint_symbol(sym_q, (unsigned long)q->detect); | 
|  | 63 |  | 
|  | 64 | printk(KERN_ERR "CYCLIC DEPENDENCY FOUND! %s depends" \ | 
|  | 65 | " on %s and vice-versa. BREAKING IT.\n", | 
|  | 66 | sym_p, sym_q); | 
|  | 67 | /* Heavy handed way..*/ | 
|  | 68 | x->depend = 0; | 
|  | 69 | } | 
|  | 70 | } | 
|  | 71 |  | 
|  | 72 | for (p = start; p < finish; p++) { | 
|  | 73 | q = find_dependents_of(p, finish, p); | 
|  | 74 | if (q && q > p) { | 
|  | 75 | sprint_symbol(sym_p, (unsigned long)p->detect); | 
|  | 76 | sprint_symbol(sym_q, (unsigned long)q->detect); | 
|  | 77 |  | 
|  | 78 | printk(KERN_ERR "EXECUTION ORDER INVALID! %s "\ | 
|  | 79 | "should be called before %s!\n", | 
|  | 80 | sym_p, sym_q); | 
|  | 81 | } | 
|  | 82 | } | 
|  | 83 | } | 
|  | 84 | #else | 
|  | 85 | inline void check_iommu_entries(struct iommu_table_entry *start, | 
|  | 86 | struct iommu_table_entry *finish) | 
|  | 87 | { | 
|  | 88 | } | 
|  | 89 | #endif |