1 #include <linux/kernel.h> 2 #include <linux/mm.h> 3 #include <linux/slab.h> 4 #include <linux/uaccess.h> 5 #include <linux/ktime.h> 6 #include <linux/debugfs.h> 7 #include <linux/highmem.h> 8 #include "gup_test.h" 9 10 static void put_back_pages(unsigned int cmd, struct page **pages, 11 unsigned long nr_pages, unsigned int gup_test_flags) 12 { 13 unsigned long i; 14 15 switch (cmd) { 16 case GUP_FAST_BENCHMARK: 17 case GUP_BASIC_TEST: 18 for (i = 0; i < nr_pages; i++) 19 put_page(pages[i]); 20 break; 21 22 case PIN_FAST_BENCHMARK: 23 case PIN_BASIC_TEST: 24 case PIN_LONGTERM_BENCHMARK: 25 unpin_user_pages(pages, nr_pages); 26 break; 27 case DUMP_USER_PAGES_TEST: 28 if (gup_test_flags & GUP_TEST_FLAG_DUMP_PAGES_USE_PIN) { 29 unpin_user_pages(pages, nr_pages); 30 } else { 31 for (i = 0; i < nr_pages; i++) 32 put_page(pages[i]); 33 34 } 35 break; 36 } 37 } 38 39 static void verify_dma_pinned(unsigned int cmd, struct page **pages, 40 unsigned long nr_pages) 41 { 42 unsigned long i; 43 struct page *page; 44 45 switch (cmd) { 46 case PIN_FAST_BENCHMARK: 47 case PIN_BASIC_TEST: 48 case PIN_LONGTERM_BENCHMARK: 49 for (i = 0; i < nr_pages; i++) { 50 page = pages[i]; 51 if (WARN(!page_maybe_dma_pinned(page), 52 "pages[%lu] is NOT dma-pinned\n", i)) { 53 54 dump_page(page, "gup_test failure"); 55 break; 56 } else if (cmd == PIN_LONGTERM_BENCHMARK && 57 WARN(!is_longterm_pinnable_page(page), 58 "pages[%lu] is NOT pinnable but pinned\n", 59 i)) { 60 dump_page(page, "gup_test failure"); 61 break; 62 } 63 } 64 break; 65 } 66 } 67 68 static void dump_pages_test(struct gup_test *gup, struct page **pages, 69 unsigned long nr_pages) 70 { 71 unsigned int index_to_dump; 72 unsigned int i; 73 74 /* 75 * Zero out any user-supplied page index that is out of range. Remember: 76 * .which_pages[] contains a 1-based set of page indices. 77 */ 78 for (i = 0; i < GUP_TEST_MAX_PAGES_TO_DUMP; i++) { 79 if (gup->which_pages[i] > nr_pages) { 80 pr_warn("ZEROING due to out of range: .which_pages[%u]: %u\n", 81 i, gup->which_pages[i]); 82 gup->which_pages[i] = 0; 83 } 84 } 85 86 for (i = 0; i < GUP_TEST_MAX_PAGES_TO_DUMP; i++) { 87 index_to_dump = gup->which_pages[i]; 88 89 if (index_to_dump) { 90 index_to_dump--; // Decode from 1-based, to 0-based 91 pr_info("---- page #%u, starting from user virt addr: 0x%llx\n", 92 index_to_dump, gup->addr); 93 dump_page(pages[index_to_dump], 94 "gup_test: dump_pages() test"); 95 } 96 } 97 } 98 99 static int __gup_test_ioctl(unsigned int cmd, 100 struct gup_test *gup) 101 { 102 ktime_t start_time, end_time; 103 unsigned long i, nr_pages, addr, next; 104 long nr; 105 struct page **pages; 106 int ret = 0; 107 bool needs_mmap_lock = 108 cmd != GUP_FAST_BENCHMARK && cmd != PIN_FAST_BENCHMARK; 109 110 if (gup->size > ULONG_MAX) 111 return -EINVAL; 112 113 nr_pages = gup->size / PAGE_SIZE; 114 pages = kvcalloc(nr_pages, sizeof(void *), GFP_KERNEL); 115 if (!pages) 116 return -ENOMEM; 117 118 if (needs_mmap_lock && mmap_read_lock_killable(current->mm)) { 119 ret = -EINTR; 120 goto free_pages; 121 } 122 123 i = 0; 124 nr = gup->nr_pages_per_call; 125 start_time = ktime_get(); 126 for (addr = gup->addr; addr < gup->addr + gup->size; addr = next) { 127 if (nr != gup->nr_pages_per_call) 128 break; 129 130 next = addr + nr * PAGE_SIZE; 131 if (next > gup->addr + gup->size) { 132 next = gup->addr + gup->size; 133 nr = (next - addr) / PAGE_SIZE; 134 } 135 136 switch (cmd) { 137 case GUP_FAST_BENCHMARK: 138 nr = get_user_pages_fast(addr, nr, gup->gup_flags, 139 pages + i); 140 break; 141 case GUP_BASIC_TEST: 142 nr = get_user_pages(addr, nr, gup->gup_flags, pages + i, 143 NULL); 144 break; 145 case PIN_FAST_BENCHMARK: 146 nr = pin_user_pages_fast(addr, nr, gup->gup_flags, 147 pages + i); 148 break; 149 case PIN_BASIC_TEST: 150 nr = pin_user_pages(addr, nr, gup->gup_flags, pages + i, 151 NULL); 152 break; 153 case PIN_LONGTERM_BENCHMARK: 154 nr = pin_user_pages(addr, nr, 155 gup->gup_flags | FOLL_LONGTERM, 156 pages + i, NULL); 157 break; 158 case DUMP_USER_PAGES_TEST: 159 if (gup->test_flags & GUP_TEST_FLAG_DUMP_PAGES_USE_PIN) 160 nr = pin_user_pages(addr, nr, gup->gup_flags, 161 pages + i, NULL); 162 else 163 nr = get_user_pages(addr, nr, gup->gup_flags, 164 pages + i, NULL); 165 break; 166 default: 167 ret = -EINVAL; 168 goto unlock; 169 } 170 171 if (nr <= 0) 172 break; 173 i += nr; 174 } 175 end_time = ktime_get(); 176 177 /* Shifting the meaning of nr_pages: now it is actual number pinned: */ 178 nr_pages = i; 179 180 gup->get_delta_usec = ktime_us_delta(end_time, start_time); 181 gup->size = addr - gup->addr; 182 183 /* 184 * Take an un-benchmark-timed moment to verify DMA pinned 185 * state: print a warning if any non-dma-pinned pages are found: 186 */ 187 verify_dma_pinned(cmd, pages, nr_pages); 188 189 if (cmd == DUMP_USER_PAGES_TEST) 190 dump_pages_test(gup, pages, nr_pages); 191 192 start_time = ktime_get(); 193 194 put_back_pages(cmd, pages, nr_pages, gup->test_flags); 195 196 end_time = ktime_get(); 197 gup->put_delta_usec = ktime_us_delta(end_time, start_time); 198 199 unlock: 200 if (needs_mmap_lock) 201 mmap_read_unlock(current->mm); 202 free_pages: 203 kvfree(pages); 204 return ret; 205 } 206 207 static DEFINE_MUTEX(pin_longterm_test_mutex); 208 static struct page **pin_longterm_test_pages; 209 static unsigned long pin_longterm_test_nr_pages; 210 211 static inline void pin_longterm_test_stop(void) 212 { 213 if (pin_longterm_test_pages) { 214 if (pin_longterm_test_nr_pages) 215 unpin_user_pages(pin_longterm_test_pages, 216 pin_longterm_test_nr_pages); 217 kvfree(pin_longterm_test_pages); 218 pin_longterm_test_pages = NULL; 219 pin_longterm_test_nr_pages = 0; 220 } 221 } 222 223 static inline int pin_longterm_test_start(unsigned long arg) 224 { 225 long nr_pages, cur_pages, addr, remaining_pages; 226 int gup_flags = FOLL_LONGTERM; 227 struct pin_longterm_test args; 228 struct page **pages; 229 int ret = 0; 230 bool fast; 231 232 if (pin_longterm_test_pages) 233 return -EINVAL; 234 235 if (copy_from_user(&args, (void __user *)arg, sizeof(args))) 236 return -EFAULT; 237 238 if (args.flags & 239 ~(PIN_LONGTERM_TEST_FLAG_USE_WRITE|PIN_LONGTERM_TEST_FLAG_USE_FAST)) 240 return -EINVAL; 241 if (!IS_ALIGNED(args.addr | args.size, PAGE_SIZE)) 242 return -EINVAL; 243 if (args.size > LONG_MAX) 244 return -EINVAL; 245 nr_pages = args.size / PAGE_SIZE; 246 if (!nr_pages) 247 return -EINVAL; 248 249 pages = kvcalloc(nr_pages, sizeof(void *), GFP_KERNEL); 250 if (!pages) 251 return -ENOMEM; 252 253 if (args.flags & PIN_LONGTERM_TEST_FLAG_USE_WRITE) 254 gup_flags |= FOLL_WRITE; 255 fast = !!(args.flags & PIN_LONGTERM_TEST_FLAG_USE_FAST); 256 257 if (!fast && mmap_read_lock_killable(current->mm)) { 258 kvfree(pages); 259 return -EINTR; 260 } 261 262 pin_longterm_test_pages = pages; 263 pin_longterm_test_nr_pages = 0; 264 265 while (nr_pages - pin_longterm_test_nr_pages) { 266 remaining_pages = nr_pages - pin_longterm_test_nr_pages; 267 addr = args.addr + pin_longterm_test_nr_pages * PAGE_SIZE; 268 269 if (fast) 270 cur_pages = pin_user_pages_fast(addr, remaining_pages, 271 gup_flags, pages); 272 else 273 cur_pages = pin_user_pages(addr, remaining_pages, 274 gup_flags, pages, NULL); 275 if (cur_pages < 0) { 276 pin_longterm_test_stop(); 277 ret = cur_pages; 278 break; 279 } 280 pin_longterm_test_nr_pages += cur_pages; 281 pages += cur_pages; 282 } 283 284 if (!fast) 285 mmap_read_unlock(current->mm); 286 return ret; 287 } 288 289 static inline int pin_longterm_test_read(unsigned long arg) 290 { 291 __u64 user_addr; 292 unsigned long i; 293 294 if (!pin_longterm_test_pages) 295 return -EINVAL; 296 297 if (copy_from_user(&user_addr, (void __user *)arg, sizeof(user_addr))) 298 return -EFAULT; 299 300 for (i = 0; i < pin_longterm_test_nr_pages; i++) { 301 void *addr = kmap_local_page(pin_longterm_test_pages[i]); 302 unsigned long ret; 303 304 ret = copy_to_user((void __user *)(unsigned long)user_addr, addr, 305 PAGE_SIZE); 306 kunmap_local(addr); 307 if (ret) 308 return -EFAULT; 309 user_addr += PAGE_SIZE; 310 } 311 return 0; 312 } 313 314 static long pin_longterm_test_ioctl(struct file *filep, unsigned int cmd, 315 unsigned long arg) 316 { 317 int ret = -EINVAL; 318 319 if (mutex_lock_killable(&pin_longterm_test_mutex)) 320 return -EINTR; 321 322 switch (cmd) { 323 case PIN_LONGTERM_TEST_START: 324 ret = pin_longterm_test_start(arg); 325 break; 326 case PIN_LONGTERM_TEST_STOP: 327 pin_longterm_test_stop(); 328 ret = 0; 329 break; 330 case PIN_LONGTERM_TEST_READ: 331 ret = pin_longterm_test_read(arg); 332 break; 333 } 334 335 mutex_unlock(&pin_longterm_test_mutex); 336 return ret; 337 } 338 339 static long gup_test_ioctl(struct file *filep, unsigned int cmd, 340 unsigned long arg) 341 { 342 struct gup_test gup; 343 int ret; 344 345 switch (cmd) { 346 case GUP_FAST_BENCHMARK: 347 case PIN_FAST_BENCHMARK: 348 case PIN_LONGTERM_BENCHMARK: 349 case GUP_BASIC_TEST: 350 case PIN_BASIC_TEST: 351 case DUMP_USER_PAGES_TEST: 352 break; 353 case PIN_LONGTERM_TEST_START: 354 case PIN_LONGTERM_TEST_STOP: 355 case PIN_LONGTERM_TEST_READ: 356 return pin_longterm_test_ioctl(filep, cmd, arg); 357 default: 358 return -EINVAL; 359 } 360 361 if (copy_from_user(&gup, (void __user *)arg, sizeof(gup))) 362 return -EFAULT; 363 364 ret = __gup_test_ioctl(cmd, &gup); 365 if (ret) 366 return ret; 367 368 if (copy_to_user((void __user *)arg, &gup, sizeof(gup))) 369 return -EFAULT; 370 371 return 0; 372 } 373 374 static int gup_test_release(struct inode *inode, struct file *file) 375 { 376 pin_longterm_test_stop(); 377 378 return 0; 379 } 380 381 static const struct file_operations gup_test_fops = { 382 .open = nonseekable_open, 383 .unlocked_ioctl = gup_test_ioctl, 384 .release = gup_test_release, 385 }; 386 387 static int __init gup_test_init(void) 388 { 389 debugfs_create_file_unsafe("gup_test", 0600, NULL, NULL, 390 &gup_test_fops); 391 392 return 0; 393 } 394 395 late_initcall(gup_test_init); 396