2 * Copyright(c) 2016 - 2017 Intel Corporation. All rights reserved.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of version 2 of the GNU General Public License as
6 * published by the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful, but
9 * WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 * General Public License for more details.
13 #include <linux/pagemap.h>
14 #include <linux/module.h>
15 #include <linux/device.h>
16 #include <linux/pfn_t.h>
17 #include <linux/cdev.h>
18 #include <linux/slab.h>
19 #include <linux/dax.h>
22 #include <linux/mman.h>
23 #include "dax-private.h"
26 static struct class *dax_class
;
29 * Rely on the fact that drvdata is set before the attributes are
30 * registered, and that the attributes are unregistered before drvdata
31 * is cleared to assume that drvdata is always valid.
33 static ssize_t
id_show(struct device
*dev
,
34 struct device_attribute
*attr
, char *buf
)
36 struct dax_region
*dax_region
= dev_get_drvdata(dev
);
38 return sprintf(buf
, "%d\n", dax_region
->id
);
40 static DEVICE_ATTR_RO(id
);
42 static ssize_t
region_size_show(struct device
*dev
,
43 struct device_attribute
*attr
, char *buf
)
45 struct dax_region
*dax_region
= dev_get_drvdata(dev
);
47 return sprintf(buf
, "%llu\n", (unsigned long long)
48 resource_size(&dax_region
->res
));
50 static struct device_attribute dev_attr_region_size
= __ATTR(size
, 0444,
51 region_size_show
, NULL
);
53 static ssize_t
align_show(struct device
*dev
,
54 struct device_attribute
*attr
, char *buf
)
56 struct dax_region
*dax_region
= dev_get_drvdata(dev
);
58 return sprintf(buf
, "%u\n", dax_region
->align
);
60 static DEVICE_ATTR_RO(align
);
62 static struct attribute
*dax_region_attributes
[] = {
63 &dev_attr_region_size
.attr
,
69 static const struct attribute_group dax_region_attribute_group
= {
71 .attrs
= dax_region_attributes
,
74 static const struct attribute_group
*dax_region_attribute_groups
[] = {
75 &dax_region_attribute_group
,
79 static void dax_region_free(struct kref
*kref
)
81 struct dax_region
*dax_region
;
83 dax_region
= container_of(kref
, struct dax_region
, kref
);
87 void dax_region_put(struct dax_region
*dax_region
)
89 kref_put(&dax_region
->kref
, dax_region_free
);
91 EXPORT_SYMBOL_GPL(dax_region_put
);
93 static void dax_region_unregister(void *region
)
95 struct dax_region
*dax_region
= region
;
97 sysfs_remove_groups(&dax_region
->dev
->kobj
,
98 dax_region_attribute_groups
);
99 dax_region_put(dax_region
);
102 struct dax_region
*alloc_dax_region(struct device
*parent
, int region_id
,
103 struct resource
*res
, unsigned int align
, void *addr
,
104 unsigned long pfn_flags
)
106 struct dax_region
*dax_region
;
109 * The DAX core assumes that it can store its private data in
110 * parent->driver_data. This WARN is a reminder / safeguard for
111 * developers of device-dax drivers.
113 if (dev_get_drvdata(parent
)) {
114 dev_WARN(parent
, "dax core failed to setup private data\n");
118 if (!IS_ALIGNED(res
->start
, align
)
119 || !IS_ALIGNED(resource_size(res
), align
))
122 dax_region
= kzalloc(sizeof(*dax_region
), GFP_KERNEL
);
126 dev_set_drvdata(parent
, dax_region
);
127 memcpy(&dax_region
->res
, res
, sizeof(*res
));
128 dax_region
->pfn_flags
= pfn_flags
;
129 kref_init(&dax_region
->kref
);
130 dax_region
->id
= region_id
;
131 ida_init(&dax_region
->ida
);
132 dax_region
->align
= align
;
133 dax_region
->dev
= parent
;
134 dax_region
->base
= addr
;
135 if (sysfs_create_groups(&parent
->kobj
, dax_region_attribute_groups
)) {
140 kref_get(&dax_region
->kref
);
141 if (devm_add_action_or_reset(parent
, dax_region_unregister
, dax_region
))
145 EXPORT_SYMBOL_GPL(alloc_dax_region
);
147 static struct dev_dax
*to_dev_dax(struct device
*dev
)
149 return container_of(dev
, struct dev_dax
, dev
);
152 static ssize_t
size_show(struct device
*dev
,
153 struct device_attribute
*attr
, char *buf
)
155 struct dev_dax
*dev_dax
= to_dev_dax(dev
);
156 unsigned long long size
= 0;
159 for (i
= 0; i
< dev_dax
->num_resources
; i
++)
160 size
+= resource_size(&dev_dax
->res
[i
]);
162 return sprintf(buf
, "%llu\n", size
);
164 static DEVICE_ATTR_RO(size
);
166 static struct attribute
*dev_dax_attributes
[] = {
171 static const struct attribute_group dev_dax_attribute_group
= {
172 .attrs
= dev_dax_attributes
,
175 static const struct attribute_group
*dax_attribute_groups
[] = {
176 &dev_dax_attribute_group
,
180 static int check_vma(struct dev_dax
*dev_dax
, struct vm_area_struct
*vma
,
183 struct dax_region
*dax_region
= dev_dax
->region
;
184 struct device
*dev
= &dev_dax
->dev
;
187 if (!dax_alive(dev_dax
->dax_dev
))
190 /* prevent private mappings from being established */
191 if ((vma
->vm_flags
& VM_MAYSHARE
) != VM_MAYSHARE
) {
192 dev_info(dev
, "%s: %s: fail, attempted private mapping\n",
193 current
->comm
, func
);
197 mask
= dax_region
->align
- 1;
198 if (vma
->vm_start
& mask
|| vma
->vm_end
& mask
) {
199 dev_info(dev
, "%s: %s: fail, unaligned vma (%#lx - %#lx, %#lx)\n",
200 current
->comm
, func
, vma
->vm_start
, vma
->vm_end
,
205 if ((dax_region
->pfn_flags
& (PFN_DEV
|PFN_MAP
)) == PFN_DEV
206 && (vma
->vm_flags
& VM_DONTCOPY
) == 0) {
207 dev_info(dev
, "%s: %s: fail, dax range requires MADV_DONTFORK\n",
208 current
->comm
, func
);
212 if (!vma_is_dax(vma
)) {
213 dev_info(dev
, "%s: %s: fail, vma is not DAX capable\n",
214 current
->comm
, func
);
221 /* see "strong" declaration in tools/testing/nvdimm/dax-dev.c */
222 __weak phys_addr_t
dax_pgoff_to_phys(struct dev_dax
*dev_dax
, pgoff_t pgoff
,
225 struct resource
*res
;
226 /* gcc-4.6.3-nolibc for i386 complains that this is uninitialized */
227 phys_addr_t
uninitialized_var(phys
);
230 for (i
= 0; i
< dev_dax
->num_resources
; i
++) {
231 res
= &dev_dax
->res
[i
];
232 phys
= pgoff
* PAGE_SIZE
+ res
->start
;
233 if (phys
>= res
->start
&& phys
<= res
->end
)
235 pgoff
-= PHYS_PFN(resource_size(res
));
238 if (i
< dev_dax
->num_resources
) {
239 res
= &dev_dax
->res
[i
];
240 if (phys
+ size
- 1 <= res
->end
)
247 static int __dev_dax_pte_fault(struct dev_dax
*dev_dax
, struct vm_fault
*vmf
)
249 struct device
*dev
= &dev_dax
->dev
;
250 struct dax_region
*dax_region
;
251 int rc
= VM_FAULT_SIGBUS
;
254 unsigned int fault_size
= PAGE_SIZE
;
256 if (check_vma(dev_dax
, vmf
->vma
, __func__
))
257 return VM_FAULT_SIGBUS
;
259 dax_region
= dev_dax
->region
;
260 if (dax_region
->align
> PAGE_SIZE
) {
261 dev_dbg(dev
, "alignment (%#x) > fault size (%#x)\n",
262 dax_region
->align
, fault_size
);
263 return VM_FAULT_SIGBUS
;
266 if (fault_size
!= dax_region
->align
)
267 return VM_FAULT_SIGBUS
;
269 phys
= dax_pgoff_to_phys(dev_dax
, vmf
->pgoff
, PAGE_SIZE
);
271 dev_dbg(dev
, "pgoff_to_phys(%#lx) failed\n", vmf
->pgoff
);
272 return VM_FAULT_SIGBUS
;
275 pfn
= phys_to_pfn_t(phys
, dax_region
->pfn_flags
);
277 rc
= vm_insert_mixed(vmf
->vma
, vmf
->address
, pfn
);
281 if (rc
< 0 && rc
!= -EBUSY
)
282 return VM_FAULT_SIGBUS
;
284 return VM_FAULT_NOPAGE
;
287 static int __dev_dax_pmd_fault(struct dev_dax
*dev_dax
, struct vm_fault
*vmf
)
289 unsigned long pmd_addr
= vmf
->address
& PMD_MASK
;
290 struct device
*dev
= &dev_dax
->dev
;
291 struct dax_region
*dax_region
;
295 unsigned int fault_size
= PMD_SIZE
;
297 if (check_vma(dev_dax
, vmf
->vma
, __func__
))
298 return VM_FAULT_SIGBUS
;
300 dax_region
= dev_dax
->region
;
301 if (dax_region
->align
> PMD_SIZE
) {
302 dev_dbg(dev
, "alignment (%#x) > fault size (%#x)\n",
303 dax_region
->align
, fault_size
);
304 return VM_FAULT_SIGBUS
;
307 /* dax pmd mappings require pfn_t_devmap() */
308 if ((dax_region
->pfn_flags
& (PFN_DEV
|PFN_MAP
)) != (PFN_DEV
|PFN_MAP
)) {
309 dev_dbg(dev
, "region lacks devmap flags\n");
310 return VM_FAULT_SIGBUS
;
313 if (fault_size
< dax_region
->align
)
314 return VM_FAULT_SIGBUS
;
315 else if (fault_size
> dax_region
->align
)
316 return VM_FAULT_FALLBACK
;
318 /* if we are outside of the VMA */
319 if (pmd_addr
< vmf
->vma
->vm_start
||
320 (pmd_addr
+ PMD_SIZE
) > vmf
->vma
->vm_end
)
321 return VM_FAULT_SIGBUS
;
323 pgoff
= linear_page_index(vmf
->vma
, pmd_addr
);
324 phys
= dax_pgoff_to_phys(dev_dax
, pgoff
, PMD_SIZE
);
326 dev_dbg(dev
, "pgoff_to_phys(%#lx) failed\n", pgoff
);
327 return VM_FAULT_SIGBUS
;
330 pfn
= phys_to_pfn_t(phys
, dax_region
->pfn_flags
);
332 return vmf_insert_pfn_pmd(vmf
->vma
, vmf
->address
, vmf
->pmd
, pfn
,
333 vmf
->flags
& FAULT_FLAG_WRITE
);
336 #ifdef CONFIG_HAVE_ARCH_TRANSPARENT_HUGEPAGE_PUD
337 static int __dev_dax_pud_fault(struct dev_dax
*dev_dax
, struct vm_fault
*vmf
)
339 unsigned long pud_addr
= vmf
->address
& PUD_MASK
;
340 struct device
*dev
= &dev_dax
->dev
;
341 struct dax_region
*dax_region
;
345 unsigned int fault_size
= PUD_SIZE
;
348 if (check_vma(dev_dax
, vmf
->vma
, __func__
))
349 return VM_FAULT_SIGBUS
;
351 dax_region
= dev_dax
->region
;
352 if (dax_region
->align
> PUD_SIZE
) {
353 dev_dbg(dev
, "alignment (%#x) > fault size (%#x)\n",
354 dax_region
->align
, fault_size
);
355 return VM_FAULT_SIGBUS
;
358 /* dax pud mappings require pfn_t_devmap() */
359 if ((dax_region
->pfn_flags
& (PFN_DEV
|PFN_MAP
)) != (PFN_DEV
|PFN_MAP
)) {
360 dev_dbg(dev
, "region lacks devmap flags\n");
361 return VM_FAULT_SIGBUS
;
364 if (fault_size
< dax_region
->align
)
365 return VM_FAULT_SIGBUS
;
366 else if (fault_size
> dax_region
->align
)
367 return VM_FAULT_FALLBACK
;
369 /* if we are outside of the VMA */
370 if (pud_addr
< vmf
->vma
->vm_start
||
371 (pud_addr
+ PUD_SIZE
) > vmf
->vma
->vm_end
)
372 return VM_FAULT_SIGBUS
;
374 pgoff
= linear_page_index(vmf
->vma
, pud_addr
);
375 phys
= dax_pgoff_to_phys(dev_dax
, pgoff
, PUD_SIZE
);
377 dev_dbg(dev
, "pgoff_to_phys(%#lx) failed\n", pgoff
);
378 return VM_FAULT_SIGBUS
;
381 pfn
= phys_to_pfn_t(phys
, dax_region
->pfn_flags
);
383 return vmf_insert_pfn_pud(vmf
->vma
, vmf
->address
, vmf
->pud
, pfn
,
384 vmf
->flags
& FAULT_FLAG_WRITE
);
387 static int __dev_dax_pud_fault(struct dev_dax
*dev_dax
, struct vm_fault
*vmf
)
389 return VM_FAULT_FALLBACK
;
391 #endif /* !CONFIG_HAVE_ARCH_TRANSPARENT_HUGEPAGE_PUD */
393 static int dev_dax_huge_fault(struct vm_fault
*vmf
,
394 enum page_entry_size pe_size
)
397 struct file
*filp
= vmf
->vma
->vm_file
;
398 struct dev_dax
*dev_dax
= filp
->private_data
;
400 dev_dbg(&dev_dax
->dev
, "%s: %s (%#lx - %#lx) size = %d\n", current
->comm
,
401 (vmf
->flags
& FAULT_FLAG_WRITE
) ? "write" : "read",
402 vmf
->vma
->vm_start
, vmf
->vma
->vm_end
, pe_size
);
404 id
= dax_read_lock();
407 rc
= __dev_dax_pte_fault(dev_dax
, vmf
);
410 rc
= __dev_dax_pmd_fault(dev_dax
, vmf
);
413 rc
= __dev_dax_pud_fault(dev_dax
, vmf
);
416 rc
= VM_FAULT_SIGBUS
;
423 static int dev_dax_fault(struct vm_fault
*vmf
)
425 return dev_dax_huge_fault(vmf
, PE_SIZE_PTE
);
428 static int dev_dax_split(struct vm_area_struct
*vma
, unsigned long addr
)
430 struct file
*filp
= vma
->vm_file
;
431 struct dev_dax
*dev_dax
= filp
->private_data
;
432 struct dax_region
*dax_region
= dev_dax
->region
;
434 if (!IS_ALIGNED(addr
, dax_region
->align
))
439 static unsigned long dev_dax_pagesize(struct vm_area_struct
*vma
)
441 struct file
*filp
= vma
->vm_file
;
442 struct dev_dax
*dev_dax
= filp
->private_data
;
443 struct dax_region
*dax_region
= dev_dax
->region
;
445 return dax_region
->align
;
448 static const struct vm_operations_struct dax_vm_ops
= {
449 .fault
= dev_dax_fault
,
450 .huge_fault
= dev_dax_huge_fault
,
451 .split
= dev_dax_split
,
452 .pagesize
= dev_dax_pagesize
,
455 static int dax_mmap(struct file
*filp
, struct vm_area_struct
*vma
)
457 struct dev_dax
*dev_dax
= filp
->private_data
;
460 dev_dbg(&dev_dax
->dev
, "trace\n");
463 * We lock to check dax_dev liveness and will re-check at
466 id
= dax_read_lock();
467 rc
= check_vma(dev_dax
, vma
, __func__
);
472 vma
->vm_ops
= &dax_vm_ops
;
473 vma
->vm_flags
|= VM_MIXEDMAP
| VM_HUGEPAGE
;
477 /* return an unmapped area aligned to the dax region specified alignment */
478 static unsigned long dax_get_unmapped_area(struct file
*filp
,
479 unsigned long addr
, unsigned long len
, unsigned long pgoff
,
482 unsigned long off
, off_end
, off_align
, len_align
, addr_align
, align
;
483 struct dev_dax
*dev_dax
= filp
? filp
->private_data
: NULL
;
484 struct dax_region
*dax_region
;
486 if (!dev_dax
|| addr
)
489 dax_region
= dev_dax
->region
;
490 align
= dax_region
->align
;
491 off
= pgoff
<< PAGE_SHIFT
;
493 off_align
= round_up(off
, align
);
495 if ((off_end
<= off_align
) || ((off_end
- off_align
) < align
))
498 len_align
= len
+ align
;
499 if ((off
+ len_align
) < off
)
502 addr_align
= current
->mm
->get_unmapped_area(filp
, addr
, len_align
,
504 if (!IS_ERR_VALUE(addr_align
)) {
505 addr_align
+= (off
- addr_align
) & (align
- 1);
509 return current
->mm
->get_unmapped_area(filp
, addr
, len
, pgoff
, flags
);
512 static int dax_open(struct inode
*inode
, struct file
*filp
)
514 struct dax_device
*dax_dev
= inode_dax(inode
);
515 struct inode
*__dax_inode
= dax_inode(dax_dev
);
516 struct dev_dax
*dev_dax
= dax_get_private(dax_dev
);
518 dev_dbg(&dev_dax
->dev
, "trace\n");
519 inode
->i_mapping
= __dax_inode
->i_mapping
;
520 inode
->i_mapping
->host
= __dax_inode
;
521 filp
->f_mapping
= inode
->i_mapping
;
522 filp
->f_wb_err
= filemap_sample_wb_err(filp
->f_mapping
);
523 filp
->private_data
= dev_dax
;
524 inode
->i_flags
= S_DAX
;
529 static int dax_release(struct inode
*inode
, struct file
*filp
)
531 struct dev_dax
*dev_dax
= filp
->private_data
;
533 dev_dbg(&dev_dax
->dev
, "trace\n");
537 static const struct file_operations dax_fops
= {
538 .llseek
= noop_llseek
,
539 .owner
= THIS_MODULE
,
541 .release
= dax_release
,
542 .get_unmapped_area
= dax_get_unmapped_area
,
544 .mmap_supported_flags
= MAP_SYNC
,
547 static void dev_dax_release(struct device
*dev
)
549 struct dev_dax
*dev_dax
= to_dev_dax(dev
);
550 struct dax_region
*dax_region
= dev_dax
->region
;
551 struct dax_device
*dax_dev
= dev_dax
->dax_dev
;
553 if (dev_dax
->id
>= 0)
554 ida_simple_remove(&dax_region
->ida
, dev_dax
->id
);
555 dax_region_put(dax_region
);
560 static void kill_dev_dax(struct dev_dax
*dev_dax
)
562 struct dax_device
*dax_dev
= dev_dax
->dax_dev
;
563 struct inode
*inode
= dax_inode(dax_dev
);
566 unmap_mapping_range(inode
->i_mapping
, 0, 0, 1);
569 static void unregister_dev_dax(void *dev
)
571 struct dev_dax
*dev_dax
= to_dev_dax(dev
);
572 struct dax_device
*dax_dev
= dev_dax
->dax_dev
;
573 struct inode
*inode
= dax_inode(dax_dev
);
574 struct cdev
*cdev
= inode
->i_cdev
;
576 dev_dbg(dev
, "trace\n");
578 kill_dev_dax(dev_dax
);
579 cdev_device_del(cdev
, dev
);
583 struct dev_dax
*devm_create_dev_dax(struct dax_region
*dax_region
,
584 int id
, struct resource
*res
, int count
)
586 struct device
*parent
= dax_region
->dev
;
587 struct dax_device
*dax_dev
;
588 struct dev_dax
*dev_dax
;
595 return ERR_PTR(-EINVAL
);
597 dev_dax
= kzalloc(struct_size(dev_dax
, res
, count
), GFP_KERNEL
);
599 return ERR_PTR(-ENOMEM
);
601 for (i
= 0; i
< count
; i
++) {
602 if (!IS_ALIGNED(res
[i
].start
, dax_region
->align
)
603 || !IS_ALIGNED(resource_size(&res
[i
]),
604 dax_region
->align
)) {
608 dev_dax
->res
[i
].start
= res
[i
].start
;
609 dev_dax
->res
[i
].end
= res
[i
].end
;
616 id
= ida_simple_get(&dax_region
->ida
, 0, 0, GFP_KERNEL
);
623 /* region provider owns @id lifetime */
628 * No 'host' or dax_operations since there is no access to this
629 * device outside of mmap of the resulting character device.
631 dax_dev
= alloc_dax(dev_dax
, NULL
, NULL
);
637 /* from here on we're committed to teardown via dax_dev_release() */
639 device_initialize(dev
);
641 inode
= dax_inode(dax_dev
);
642 cdev
= inode
->i_cdev
;
643 cdev_init(cdev
, &dax_fops
);
644 cdev
->owner
= parent
->driver
->owner
;
646 dev_dax
->num_resources
= count
;
647 dev_dax
->dax_dev
= dax_dev
;
648 dev_dax
->region
= dax_region
;
649 kref_get(&dax_region
->kref
);
651 dev
->devt
= inode
->i_rdev
;
652 dev
->class = dax_class
;
653 dev
->parent
= parent
;
654 dev
->groups
= dax_attribute_groups
;
655 dev
->release
= dev_dax_release
;
656 dev_set_name(dev
, "dax%d.%d", dax_region
->id
, id
);
658 rc
= cdev_device_add(cdev
, dev
);
660 kill_dev_dax(dev_dax
);
665 rc
= devm_add_action_or_reset(dax_region
->dev
, unregister_dev_dax
, dev
);
672 if (dev_dax
->id
>= 0)
673 ida_simple_remove(&dax_region
->ida
, dev_dax
->id
);
679 EXPORT_SYMBOL_GPL(devm_create_dev_dax
);
681 static int __init
dax_init(void)
683 dax_class
= class_create(THIS_MODULE
, "dax");
684 return PTR_ERR_OR_ZERO(dax_class
);
687 static void __exit
dax_exit(void)
689 class_destroy(dax_class
);
692 MODULE_AUTHOR("Intel Corporation");
693 MODULE_LICENSE("GPL v2");
694 subsys_initcall(dax_init
);
695 module_exit(dax_exit
);