Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 1 | /* |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 2 | * Written by Pekka Paalanen, 2008-2009 <pq@iki.fi> |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 3 | */ |
| 4 | #include <linux/module.h> |
Pekka Paalanen | 970e6fa | 2008-05-12 21:21:03 +0200 | [diff] [blame] | 5 | #include <linux/io.h> |
Pekka Paalanen | 9e57fb3 | 2008-09-16 22:00:34 +0300 | [diff] [blame] | 6 | #include <linux/mmiotrace.h> |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 7 | |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 8 | #define MODULE_NAME "testmmiotrace" |
| 9 | |
| 10 | static unsigned long mmio_address; |
| 11 | module_param(mmio_address, ulong, 0); |
Pekka Paalanen | 5ff9369 | 2009-03-01 16:10:08 +0200 | [diff] [blame] | 12 | MODULE_PARM_DESC(mmio_address, " Start address of the mapping of 16 kB " |
| 13 | "(or 8 MB if read_far is non-zero)."); |
| 14 | |
| 15 | static unsigned long read_far = 0x400100; |
| 16 | module_param(read_far, ulong, 0); |
| 17 | MODULE_PARM_DESC(read_far, " Offset of a 32-bit read within 8 MB " |
| 18 | "(default: 0x400100)."); |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 19 | |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 20 | static unsigned v16(unsigned i) |
| 21 | { |
| 22 | return i * 12 + 7; |
| 23 | } |
| 24 | |
| 25 | static unsigned v32(unsigned i) |
| 26 | { |
| 27 | return i * 212371 + 13; |
| 28 | } |
| 29 | |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 30 | static void do_write_test(void __iomem *p) |
| 31 | { |
| 32 | unsigned int i; |
Pekka Paalanen | 5ff9369 | 2009-03-01 16:10:08 +0200 | [diff] [blame] | 33 | pr_info(MODULE_NAME ": write test.\n"); |
Pekka Paalanen | 9e57fb3 | 2008-09-16 22:00:34 +0300 | [diff] [blame] | 34 | mmiotrace_printk("Write test.\n"); |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 35 | |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 36 | for (i = 0; i < 256; i++) |
| 37 | iowrite8(i, p + i); |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 38 | |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 39 | for (i = 1024; i < (5 * 1024); i += 2) |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 40 | iowrite16(v16(i), p + i); |
| 41 | |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 42 | for (i = (5 * 1024); i < (16 * 1024); i += 4) |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 43 | iowrite32(v32(i), p + i); |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 44 | } |
| 45 | |
| 46 | static void do_read_test(void __iomem *p) |
| 47 | { |
| 48 | unsigned int i; |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 49 | unsigned errs[3] = { 0 }; |
Pekka Paalanen | 5ff9369 | 2009-03-01 16:10:08 +0200 | [diff] [blame] | 50 | pr_info(MODULE_NAME ": read test.\n"); |
Pekka Paalanen | 9e57fb3 | 2008-09-16 22:00:34 +0300 | [diff] [blame] | 51 | mmiotrace_printk("Read test.\n"); |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 52 | |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 53 | for (i = 0; i < 256; i++) |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 54 | if (ioread8(p + i) != i) |
| 55 | ++errs[0]; |
| 56 | |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 57 | for (i = 1024; i < (5 * 1024); i += 2) |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 58 | if (ioread16(p + i) != v16(i)) |
| 59 | ++errs[1]; |
| 60 | |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 61 | for (i = (5 * 1024); i < (16 * 1024); i += 4) |
Pekka Paalanen | fab852a | 2009-03-01 16:09:14 +0200 | [diff] [blame] | 62 | if (ioread32(p + i) != v32(i)) |
| 63 | ++errs[2]; |
| 64 | |
| 65 | mmiotrace_printk("Read errors: 8-bit %d, 16-bit %d, 32-bit %d.\n", |
| 66 | errs[0], errs[1], errs[2]); |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 67 | } |
| 68 | |
Pekka Paalanen | 5ff9369 | 2009-03-01 16:10:08 +0200 | [diff] [blame] | 69 | static void do_read_far_test(void __iomem *p) |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 70 | { |
Pekka Paalanen | 5ff9369 | 2009-03-01 16:10:08 +0200 | [diff] [blame] | 71 | pr_info(MODULE_NAME ": read far test.\n"); |
| 72 | mmiotrace_printk("Read far test.\n"); |
| 73 | |
| 74 | ioread32(p + read_far); |
| 75 | } |
| 76 | |
| 77 | static void do_test(unsigned long size) |
| 78 | { |
| 79 | void __iomem *p = ioremap_nocache(mmio_address, size); |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 80 | if (!p) { |
Pekka Paalanen | 0fd0e3d | 2008-05-12 21:20:57 +0200 | [diff] [blame] | 81 | pr_err(MODULE_NAME ": could not ioremap, aborting.\n"); |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 82 | return; |
| 83 | } |
Pekka Paalanen | 9e57fb3 | 2008-09-16 22:00:34 +0300 | [diff] [blame] | 84 | mmiotrace_printk("ioremap returned %p.\n", p); |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 85 | do_write_test(p); |
| 86 | do_read_test(p); |
Pekka Paalanen | 5ff9369 | 2009-03-01 16:10:08 +0200 | [diff] [blame] | 87 | if (read_far && read_far < size - 4) |
| 88 | do_read_far_test(p); |
Pekka Paalanen | d61fc44 | 2008-05-12 21:20:57 +0200 | [diff] [blame] | 89 | iounmap(p); |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 90 | } |
| 91 | |
| 92 | static int __init init(void) |
| 93 | { |
Pekka Paalanen | 5ff9369 | 2009-03-01 16:10:08 +0200 | [diff] [blame] | 94 | unsigned long size = (read_far) ? (8 << 20) : (16 << 10); |
| 95 | |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 96 | if (mmio_address == 0) { |
Pekka Paalanen | 0fd0e3d | 2008-05-12 21:20:57 +0200 | [diff] [blame] | 97 | pr_err(MODULE_NAME ": you have to use the module argument " |
| 98 | "mmio_address.\n"); |
| 99 | pr_err(MODULE_NAME ": DO NOT LOAD THIS MODULE UNLESS" |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 100 | " YOU REALLY KNOW WHAT YOU ARE DOING!\n"); |
| 101 | return -ENXIO; |
| 102 | } |
| 103 | |
Pekka Paalanen | 5ff9369 | 2009-03-01 16:10:08 +0200 | [diff] [blame] | 104 | pr_warning(MODULE_NAME ": WARNING: mapping %lu kB @ 0x%08lx in PCI " |
| 105 | "address space, and writing 16 kB of rubbish in there.\n", |
| 106 | size >> 10, mmio_address); |
| 107 | do_test(size); |
| 108 | pr_info(MODULE_NAME ": All done.\n"); |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 109 | return 0; |
| 110 | } |
| 111 | |
| 112 | static void __exit cleanup(void) |
| 113 | { |
Pekka Paalanen | 0fd0e3d | 2008-05-12 21:20:57 +0200 | [diff] [blame] | 114 | pr_debug(MODULE_NAME ": unloaded.\n"); |
Pekka Paalanen | 8b7d89d | 2008-05-12 21:20:56 +0200 | [diff] [blame] | 115 | } |
| 116 | |
| 117 | module_init(init); |
| 118 | module_exit(cleanup); |
| 119 | MODULE_LICENSE("GPL"); |