pmem.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Persistent Memory Driver
  4. *
  5. * Copyright (c) 2014-2015, Intel Corporation.
  6. * Copyright (c) 2015, Christoph Hellwig <hch@lst.de>.
  7. * Copyright (c) 2015, Boaz Harrosh <boaz@plexistor.com>.
  8. */
  9. #include <linux/blkdev.h>
  10. #include <linux/pagemap.h>
  11. #include <linux/hdreg.h>
  12. #include <linux/init.h>
  13. #include <linux/platform_device.h>
  14. #include <linux/set_memory.h>
  15. #include <linux/module.h>
  16. #include <linux/moduleparam.h>
  17. #include <linux/badblocks.h>
  18. #include <linux/memremap.h>
  19. #include <linux/kstrtox.h>
  20. #include <linux/vmalloc.h>
  21. #include <linux/blk-mq.h>
  22. #include <linux/pfn_t.h>
  23. #include <linux/slab.h>
  24. #include <linux/uio.h>
  25. #include <linux/dax.h>
  26. #include <linux/nd.h>
  27. #include <linux/mm.h>
  28. #include <asm/cacheflush.h>
  29. #include "pmem.h"
  30. #include "btt.h"
  31. #include "pfn.h"
  32. #include "nd.h"
  33. static struct device *to_dev(struct pmem_device *pmem)
  34. {
  35. /*
  36. * nvdimm bus services need a 'dev' parameter, and we record the device
  37. * at init in bb.dev.
  38. */
  39. return pmem->bb.dev;
  40. }
  41. static struct nd_region *to_region(struct pmem_device *pmem)
  42. {
  43. return to_nd_region(to_dev(pmem)->parent);
  44. }
  45. static phys_addr_t pmem_to_phys(struct pmem_device *pmem, phys_addr_t offset)
  46. {
  47. return pmem->phys_addr + offset;
  48. }
  49. static sector_t to_sect(struct pmem_device *pmem, phys_addr_t offset)
  50. {
  51. return (offset - pmem->data_offset) >> SECTOR_SHIFT;
  52. }
  53. static phys_addr_t to_offset(struct pmem_device *pmem, sector_t sector)
  54. {
  55. return (sector << SECTOR_SHIFT) + pmem->data_offset;
  56. }
  57. static void pmem_mkpage_present(struct pmem_device *pmem, phys_addr_t offset,
  58. unsigned int len)
  59. {
  60. phys_addr_t phys = pmem_to_phys(pmem, offset);
  61. unsigned long pfn_start, pfn_end, pfn;
  62. /* only pmem in the linear map supports HWPoison */
  63. if (is_vmalloc_addr(pmem->virt_addr))
  64. return;
  65. pfn_start = PHYS_PFN(phys);
  66. pfn_end = pfn_start + PHYS_PFN(len);
  67. for (pfn = pfn_start; pfn < pfn_end; pfn++) {
  68. struct page *page = pfn_to_page(pfn);
  69. /*
  70. * Note, no need to hold a get_dev_pagemap() reference
  71. * here since we're in the driver I/O path and
  72. * outstanding I/O requests pin the dev_pagemap.
  73. */
  74. if (test_and_clear_pmem_poison(page))
  75. clear_mce_nospec(pfn);
  76. }
  77. }
  78. static void pmem_clear_bb(struct pmem_device *pmem, sector_t sector, long blks)
  79. {
  80. if (blks == 0)
  81. return;
  82. badblocks_clear(&pmem->bb, sector, blks);
  83. if (pmem->bb_state)
  84. sysfs_notify_dirent(pmem->bb_state);
  85. }
  86. static long __pmem_clear_poison(struct pmem_device *pmem,
  87. phys_addr_t offset, unsigned int len)
  88. {
  89. phys_addr_t phys = pmem_to_phys(pmem, offset);
  90. long cleared = nvdimm_clear_poison(to_dev(pmem), phys, len);
  91. if (cleared > 0) {
  92. pmem_mkpage_present(pmem, offset, cleared);
  93. arch_invalidate_pmem(pmem->virt_addr + offset, len);
  94. }
  95. return cleared;
  96. }
  97. static blk_status_t pmem_clear_poison(struct pmem_device *pmem,
  98. phys_addr_t offset, unsigned int len)
  99. {
  100. long cleared = __pmem_clear_poison(pmem, offset, len);
  101. if (cleared < 0)
  102. return BLK_STS_IOERR;
  103. pmem_clear_bb(pmem, to_sect(pmem, offset), cleared >> SECTOR_SHIFT);
  104. if (cleared < len)
  105. return BLK_STS_IOERR;
  106. return BLK_STS_OK;
  107. }
  108. static void write_pmem(void *pmem_addr, struct page *page,
  109. unsigned int off, unsigned int len)
  110. {
  111. unsigned int chunk;
  112. void *mem;
  113. while (len) {
  114. mem = kmap_atomic(page);
  115. chunk = min_t(unsigned int, len, PAGE_SIZE - off);
  116. memcpy_flushcache(pmem_addr, mem + off, chunk);
  117. kunmap_atomic(mem);
  118. len -= chunk;
  119. off = 0;
  120. page++;
  121. pmem_addr += chunk;
  122. }
  123. }
  124. static blk_status_t read_pmem(struct page *page, unsigned int off,
  125. void *pmem_addr, unsigned int len)
  126. {
  127. unsigned int chunk;
  128. unsigned long rem;
  129. void *mem;
  130. while (len) {
  131. mem = kmap_atomic(page);
  132. chunk = min_t(unsigned int, len, PAGE_SIZE - off);
  133. rem = copy_mc_to_kernel(mem + off, pmem_addr, chunk);
  134. kunmap_atomic(mem);
  135. if (rem)
  136. return BLK_STS_IOERR;
  137. len -= chunk;
  138. off = 0;
  139. page++;
  140. pmem_addr += chunk;
  141. }
  142. return BLK_STS_OK;
  143. }
  144. static blk_status_t pmem_do_read(struct pmem_device *pmem,
  145. struct page *page, unsigned int page_off,
  146. sector_t sector, unsigned int len)
  147. {
  148. blk_status_t rc;
  149. phys_addr_t pmem_off = to_offset(pmem, sector);
  150. void *pmem_addr = pmem->virt_addr + pmem_off;
  151. if (unlikely(is_bad_pmem(&pmem->bb, sector, len)))
  152. return BLK_STS_IOERR;
  153. rc = read_pmem(page, page_off, pmem_addr, len);
  154. flush_dcache_page(page);
  155. return rc;
  156. }
  157. static blk_status_t pmem_do_write(struct pmem_device *pmem,
  158. struct page *page, unsigned int page_off,
  159. sector_t sector, unsigned int len)
  160. {
  161. phys_addr_t pmem_off = to_offset(pmem, sector);
  162. void *pmem_addr = pmem->virt_addr + pmem_off;
  163. if (unlikely(is_bad_pmem(&pmem->bb, sector, len))) {
  164. blk_status_t rc = pmem_clear_poison(pmem, pmem_off, len);
  165. if (rc != BLK_STS_OK)
  166. return rc;
  167. }
  168. flush_dcache_page(page);
  169. write_pmem(pmem_addr, page, page_off, len);
  170. return BLK_STS_OK;
  171. }
  172. static void pmem_submit_bio(struct bio *bio)
  173. {
  174. int ret = 0;
  175. blk_status_t rc = 0;
  176. bool do_acct;
  177. unsigned long start;
  178. struct bio_vec bvec;
  179. struct bvec_iter iter;
  180. struct pmem_device *pmem = bio->bi_bdev->bd_disk->private_data;
  181. struct nd_region *nd_region = to_region(pmem);
  182. if (bio->bi_opf & REQ_PREFLUSH)
  183. ret = nvdimm_flush(nd_region, bio);
  184. do_acct = blk_queue_io_stat(bio->bi_bdev->bd_disk->queue);
  185. if (do_acct)
  186. start = bio_start_io_acct(bio);
  187. bio_for_each_segment(bvec, bio, iter) {
  188. if (op_is_write(bio_op(bio)))
  189. rc = pmem_do_write(pmem, bvec.bv_page, bvec.bv_offset,
  190. iter.bi_sector, bvec.bv_len);
  191. else
  192. rc = pmem_do_read(pmem, bvec.bv_page, bvec.bv_offset,
  193. iter.bi_sector, bvec.bv_len);
  194. if (rc) {
  195. bio->bi_status = rc;
  196. break;
  197. }
  198. }
  199. if (do_acct)
  200. bio_end_io_acct(bio, start);
  201. if (bio->bi_opf & REQ_FUA)
  202. ret = nvdimm_flush(nd_region, bio);
  203. if (ret)
  204. bio->bi_status = errno_to_blk_status(ret);
  205. bio_endio(bio);
  206. }
  207. /* see "strong" declaration in tools/testing/nvdimm/pmem-dax.c */
  208. __weak long __pmem_direct_access(struct pmem_device *pmem, pgoff_t pgoff,
  209. long nr_pages, enum dax_access_mode mode, void **kaddr,
  210. pfn_t *pfn)
  211. {
  212. resource_size_t offset = PFN_PHYS(pgoff) + pmem->data_offset;
  213. sector_t sector = PFN_PHYS(pgoff) >> SECTOR_SHIFT;
  214. unsigned int num = PFN_PHYS(nr_pages) >> SECTOR_SHIFT;
  215. struct badblocks *bb = &pmem->bb;
  216. sector_t first_bad;
  217. int num_bad;
  218. if (kaddr)
  219. *kaddr = pmem->virt_addr + offset;
  220. if (pfn)
  221. *pfn = phys_to_pfn_t(pmem->phys_addr + offset, pmem->pfn_flags);
  222. if (bb->count &&
  223. badblocks_check(bb, sector, num, &first_bad, &num_bad)) {
  224. long actual_nr;
  225. if (mode != DAX_RECOVERY_WRITE)
  226. return -EHWPOISON;
  227. /*
  228. * Set the recovery stride is set to kernel page size because
  229. * the underlying driver and firmware clear poison functions
  230. * don't appear to handle large chunk(such as 2MiB) reliably.
  231. */
  232. actual_nr = PHYS_PFN(
  233. PAGE_ALIGN((first_bad - sector) << SECTOR_SHIFT));
  234. dev_dbg(pmem->bb.dev, "start sector(%llu), nr_pages(%ld), first_bad(%llu), actual_nr(%ld)\n",
  235. sector, nr_pages, first_bad, actual_nr);
  236. if (actual_nr)
  237. return actual_nr;
  238. return 1;
  239. }
  240. /*
  241. * If badblocks are present but not in the range, limit known good range
  242. * to the requested range.
  243. */
  244. if (bb->count)
  245. return nr_pages;
  246. return PHYS_PFN(pmem->size - pmem->pfn_pad - offset);
  247. }
  248. static const struct block_device_operations pmem_fops = {
  249. .owner = THIS_MODULE,
  250. .submit_bio = pmem_submit_bio,
  251. };
  252. static int pmem_dax_zero_page_range(struct dax_device *dax_dev, pgoff_t pgoff,
  253. size_t nr_pages)
  254. {
  255. struct pmem_device *pmem = dax_get_private(dax_dev);
  256. return blk_status_to_errno(pmem_do_write(pmem, ZERO_PAGE(0), 0,
  257. PFN_PHYS(pgoff) >> SECTOR_SHIFT,
  258. PAGE_SIZE));
  259. }
  260. static long pmem_dax_direct_access(struct dax_device *dax_dev,
  261. pgoff_t pgoff, long nr_pages, enum dax_access_mode mode,
  262. void **kaddr, pfn_t *pfn)
  263. {
  264. struct pmem_device *pmem = dax_get_private(dax_dev);
  265. return __pmem_direct_access(pmem, pgoff, nr_pages, mode, kaddr, pfn);
  266. }
  267. /*
  268. * The recovery write thread started out as a normal pwrite thread and
  269. * when the filesystem was told about potential media error in the
  270. * range, filesystem turns the normal pwrite to a dax_recovery_write.
  271. *
  272. * The recovery write consists of clearing media poison, clearing page
  273. * HWPoison bit, reenable page-wide read-write permission, flush the
  274. * caches and finally write. A competing pread thread will be held
  275. * off during the recovery process since data read back might not be
  276. * valid, and this is achieved by clearing the badblock records after
  277. * the recovery write is complete. Competing recovery write threads
  278. * are already serialized by writer lock held by dax_iomap_rw().
  279. */
  280. static size_t pmem_recovery_write(struct dax_device *dax_dev, pgoff_t pgoff,
  281. void *addr, size_t bytes, struct iov_iter *i)
  282. {
  283. struct pmem_device *pmem = dax_get_private(dax_dev);
  284. size_t olen, len, off;
  285. phys_addr_t pmem_off;
  286. struct device *dev = pmem->bb.dev;
  287. long cleared;
  288. off = offset_in_page(addr);
  289. len = PFN_PHYS(PFN_UP(off + bytes));
  290. if (!is_bad_pmem(&pmem->bb, PFN_PHYS(pgoff) >> SECTOR_SHIFT, len))
  291. return _copy_from_iter_flushcache(addr, bytes, i);
  292. /*
  293. * Not page-aligned range cannot be recovered. This should not
  294. * happen unless something else went wrong.
  295. */
  296. if (off || !PAGE_ALIGNED(bytes)) {
  297. dev_dbg(dev, "Found poison, but addr(%p) or bytes(%#zx) not page aligned\n",
  298. addr, bytes);
  299. return 0;
  300. }
  301. pmem_off = PFN_PHYS(pgoff) + pmem->data_offset;
  302. cleared = __pmem_clear_poison(pmem, pmem_off, len);
  303. if (cleared > 0 && cleared < len) {
  304. dev_dbg(dev, "poison cleared only %ld out of %zu bytes\n",
  305. cleared, len);
  306. return 0;
  307. }
  308. if (cleared < 0) {
  309. dev_dbg(dev, "poison clear failed: %ld\n", cleared);
  310. return 0;
  311. }
  312. olen = _copy_from_iter_flushcache(addr, bytes, i);
  313. pmem_clear_bb(pmem, to_sect(pmem, pmem_off), cleared >> SECTOR_SHIFT);
  314. return olen;
  315. }
  316. static const struct dax_operations pmem_dax_ops = {
  317. .direct_access = pmem_dax_direct_access,
  318. .zero_page_range = pmem_dax_zero_page_range,
  319. .recovery_write = pmem_recovery_write,
  320. };
  321. static ssize_t write_cache_show(struct device *dev,
  322. struct device_attribute *attr, char *buf)
  323. {
  324. struct pmem_device *pmem = dev_to_disk(dev)->private_data;
  325. return sprintf(buf, "%d\n", !!dax_write_cache_enabled(pmem->dax_dev));
  326. }
  327. static ssize_t write_cache_store(struct device *dev,
  328. struct device_attribute *attr, const char *buf, size_t len)
  329. {
  330. struct pmem_device *pmem = dev_to_disk(dev)->private_data;
  331. bool write_cache;
  332. int rc;
  333. rc = kstrtobool(buf, &write_cache);
  334. if (rc)
  335. return rc;
  336. dax_write_cache(pmem->dax_dev, write_cache);
  337. return len;
  338. }
  339. static DEVICE_ATTR_RW(write_cache);
  340. static umode_t dax_visible(struct kobject *kobj, struct attribute *a, int n)
  341. {
  342. #ifndef CONFIG_ARCH_HAS_PMEM_API
  343. if (a == &dev_attr_write_cache.attr)
  344. return 0;
  345. #endif
  346. return a->mode;
  347. }
  348. static struct attribute *dax_attributes[] = {
  349. &dev_attr_write_cache.attr,
  350. NULL,
  351. };
  352. static const struct attribute_group dax_attribute_group = {
  353. .name = "dax",
  354. .attrs = dax_attributes,
  355. .is_visible = dax_visible,
  356. };
  357. static const struct attribute_group *pmem_attribute_groups[] = {
  358. &dax_attribute_group,
  359. NULL,
  360. };
  361. static void pmem_release_disk(void *__pmem)
  362. {
  363. struct pmem_device *pmem = __pmem;
  364. dax_remove_host(pmem->disk);
  365. kill_dax(pmem->dax_dev);
  366. put_dax(pmem->dax_dev);
  367. del_gendisk(pmem->disk);
  368. put_disk(pmem->disk);
  369. }
  370. static int pmem_pagemap_memory_failure(struct dev_pagemap *pgmap,
  371. unsigned long pfn, unsigned long nr_pages, int mf_flags)
  372. {
  373. struct pmem_device *pmem =
  374. container_of(pgmap, struct pmem_device, pgmap);
  375. u64 offset = PFN_PHYS(pfn) - pmem->phys_addr - pmem->data_offset;
  376. u64 len = nr_pages << PAGE_SHIFT;
  377. return dax_holder_notify_failure(pmem->dax_dev, offset, len, mf_flags);
  378. }
  379. static const struct dev_pagemap_ops fsdax_pagemap_ops = {
  380. .memory_failure = pmem_pagemap_memory_failure,
  381. };
  382. static int pmem_attach_disk(struct device *dev,
  383. struct nd_namespace_common *ndns)
  384. {
  385. struct nd_namespace_io *nsio = to_nd_namespace_io(&ndns->dev);
  386. struct nd_region *nd_region = to_nd_region(dev->parent);
  387. struct queue_limits lim = {
  388. .logical_block_size = pmem_sector_size(ndns),
  389. .physical_block_size = PAGE_SIZE,
  390. .max_hw_sectors = UINT_MAX,
  391. .features = BLK_FEAT_WRITE_CACHE |
  392. BLK_FEAT_SYNCHRONOUS,
  393. };
  394. int nid = dev_to_node(dev), fua;
  395. struct resource *res = &nsio->res;
  396. struct range bb_range;
  397. struct nd_pfn *nd_pfn = NULL;
  398. struct dax_device *dax_dev;
  399. struct nd_pfn_sb *pfn_sb;
  400. struct pmem_device *pmem;
  401. struct gendisk *disk;
  402. void *addr;
  403. int rc;
  404. pmem = devm_kzalloc(dev, sizeof(*pmem), GFP_KERNEL);
  405. if (!pmem)
  406. return -ENOMEM;
  407. rc = devm_namespace_enable(dev, ndns, nd_info_block_reserve());
  408. if (rc)
  409. return rc;
  410. /* while nsio_rw_bytes is active, parse a pfn info block if present */
  411. if (is_nd_pfn(dev)) {
  412. nd_pfn = to_nd_pfn(dev);
  413. rc = nvdimm_setup_pfn(nd_pfn, &pmem->pgmap);
  414. if (rc)
  415. return rc;
  416. }
  417. /* we're attaching a block device, disable raw namespace access */
  418. devm_namespace_disable(dev, ndns);
  419. dev_set_drvdata(dev, pmem);
  420. pmem->phys_addr = res->start;
  421. pmem->size = resource_size(res);
  422. fua = nvdimm_has_flush(nd_region);
  423. if (!IS_ENABLED(CONFIG_ARCH_HAS_UACCESS_FLUSHCACHE) || fua < 0) {
  424. dev_warn(dev, "unable to guarantee persistence of writes\n");
  425. fua = 0;
  426. }
  427. if (fua)
  428. lim.features |= BLK_FEAT_FUA;
  429. if (is_nd_pfn(dev) || pmem_should_map_pages(dev))
  430. lim.features |= BLK_FEAT_DAX;
  431. if (!devm_request_mem_region(dev, res->start, resource_size(res),
  432. dev_name(&ndns->dev))) {
  433. dev_warn(dev, "could not reserve region %pR\n", res);
  434. return -EBUSY;
  435. }
  436. disk = blk_alloc_disk(&lim, nid);
  437. if (IS_ERR(disk))
  438. return PTR_ERR(disk);
  439. pmem->disk = disk;
  440. pmem->pgmap.owner = pmem;
  441. pmem->pfn_flags = PFN_DEV;
  442. if (is_nd_pfn(dev)) {
  443. pmem->pgmap.type = MEMORY_DEVICE_FS_DAX;
  444. pmem->pgmap.ops = &fsdax_pagemap_ops;
  445. addr = devm_memremap_pages(dev, &pmem->pgmap);
  446. pfn_sb = nd_pfn->pfn_sb;
  447. pmem->data_offset = le64_to_cpu(pfn_sb->dataoff);
  448. pmem->pfn_pad = resource_size(res) -
  449. range_len(&pmem->pgmap.range);
  450. pmem->pfn_flags |= PFN_MAP;
  451. bb_range = pmem->pgmap.range;
  452. bb_range.start += pmem->data_offset;
  453. } else if (pmem_should_map_pages(dev)) {
  454. pmem->pgmap.range.start = res->start;
  455. pmem->pgmap.range.end = res->end;
  456. pmem->pgmap.nr_range = 1;
  457. pmem->pgmap.type = MEMORY_DEVICE_FS_DAX;
  458. pmem->pgmap.ops = &fsdax_pagemap_ops;
  459. addr = devm_memremap_pages(dev, &pmem->pgmap);
  460. pmem->pfn_flags |= PFN_MAP;
  461. bb_range = pmem->pgmap.range;
  462. } else {
  463. addr = devm_memremap(dev, pmem->phys_addr,
  464. pmem->size, ARCH_MEMREMAP_PMEM);
  465. bb_range.start = res->start;
  466. bb_range.end = res->end;
  467. }
  468. if (IS_ERR(addr)) {
  469. rc = PTR_ERR(addr);
  470. goto out;
  471. }
  472. pmem->virt_addr = addr;
  473. disk->fops = &pmem_fops;
  474. disk->private_data = pmem;
  475. nvdimm_namespace_disk_name(ndns, disk->disk_name);
  476. set_capacity(disk, (pmem->size - pmem->pfn_pad - pmem->data_offset)
  477. / 512);
  478. if (devm_init_badblocks(dev, &pmem->bb))
  479. return -ENOMEM;
  480. nvdimm_badblocks_populate(nd_region, &pmem->bb, &bb_range);
  481. disk->bb = &pmem->bb;
  482. dax_dev = alloc_dax(pmem, &pmem_dax_ops);
  483. if (IS_ERR(dax_dev)) {
  484. rc = PTR_ERR(dax_dev);
  485. if (rc != -EOPNOTSUPP)
  486. goto out;
  487. } else {
  488. set_dax_nocache(dax_dev);
  489. set_dax_nomc(dax_dev);
  490. if (is_nvdimm_sync(nd_region))
  491. set_dax_synchronous(dax_dev);
  492. pmem->dax_dev = dax_dev;
  493. rc = dax_add_host(dax_dev, disk);
  494. if (rc)
  495. goto out_cleanup_dax;
  496. dax_write_cache(dax_dev, nvdimm_has_cache(nd_region));
  497. }
  498. rc = device_add_disk(dev, disk, pmem_attribute_groups);
  499. if (rc)
  500. goto out_remove_host;
  501. if (devm_add_action_or_reset(dev, pmem_release_disk, pmem))
  502. return -ENOMEM;
  503. nvdimm_check_and_set_ro(disk);
  504. pmem->bb_state = sysfs_get_dirent(disk_to_dev(disk)->kobj.sd,
  505. "badblocks");
  506. if (!pmem->bb_state)
  507. dev_warn(dev, "'badblocks' notification disabled\n");
  508. return 0;
  509. out_remove_host:
  510. dax_remove_host(pmem->disk);
  511. out_cleanup_dax:
  512. kill_dax(pmem->dax_dev);
  513. put_dax(pmem->dax_dev);
  514. out:
  515. put_disk(pmem->disk);
  516. return rc;
  517. }
  518. static int nd_pmem_probe(struct device *dev)
  519. {
  520. int ret;
  521. struct nd_namespace_common *ndns;
  522. ndns = nvdimm_namespace_common_probe(dev);
  523. if (IS_ERR(ndns))
  524. return PTR_ERR(ndns);
  525. if (is_nd_btt(dev))
  526. return nvdimm_namespace_attach_btt(ndns);
  527. if (is_nd_pfn(dev))
  528. return pmem_attach_disk(dev, ndns);
  529. ret = devm_namespace_enable(dev, ndns, nd_info_block_reserve());
  530. if (ret)
  531. return ret;
  532. ret = nd_btt_probe(dev, ndns);
  533. if (ret == 0)
  534. return -ENXIO;
  535. /*
  536. * We have two failure conditions here, there is no
  537. * info reserver block or we found a valid info reserve block
  538. * but failed to initialize the pfn superblock.
  539. *
  540. * For the first case consider namespace as a raw pmem namespace
  541. * and attach a disk.
  542. *
  543. * For the latter, consider this a success and advance the namespace
  544. * seed.
  545. */
  546. ret = nd_pfn_probe(dev, ndns);
  547. if (ret == 0)
  548. return -ENXIO;
  549. else if (ret == -EOPNOTSUPP)
  550. return ret;
  551. ret = nd_dax_probe(dev, ndns);
  552. if (ret == 0)
  553. return -ENXIO;
  554. else if (ret == -EOPNOTSUPP)
  555. return ret;
  556. /* probe complete, attach handles namespace enabling */
  557. devm_namespace_disable(dev, ndns);
  558. return pmem_attach_disk(dev, ndns);
  559. }
  560. static void nd_pmem_remove(struct device *dev)
  561. {
  562. struct pmem_device *pmem = dev_get_drvdata(dev);
  563. if (is_nd_btt(dev))
  564. nvdimm_namespace_detach_btt(to_nd_btt(dev));
  565. else {
  566. /*
  567. * Note, this assumes device_lock() context to not
  568. * race nd_pmem_notify()
  569. */
  570. sysfs_put(pmem->bb_state);
  571. pmem->bb_state = NULL;
  572. }
  573. nvdimm_flush(to_nd_region(dev->parent), NULL);
  574. }
  575. static void nd_pmem_shutdown(struct device *dev)
  576. {
  577. nvdimm_flush(to_nd_region(dev->parent), NULL);
  578. }
  579. static void pmem_revalidate_poison(struct device *dev)
  580. {
  581. struct nd_region *nd_region;
  582. resource_size_t offset = 0, end_trunc = 0;
  583. struct nd_namespace_common *ndns;
  584. struct nd_namespace_io *nsio;
  585. struct badblocks *bb;
  586. struct range range;
  587. struct kernfs_node *bb_state;
  588. if (is_nd_btt(dev)) {
  589. struct nd_btt *nd_btt = to_nd_btt(dev);
  590. ndns = nd_btt->ndns;
  591. nd_region = to_nd_region(ndns->dev.parent);
  592. nsio = to_nd_namespace_io(&ndns->dev);
  593. bb = &nsio->bb;
  594. bb_state = NULL;
  595. } else {
  596. struct pmem_device *pmem = dev_get_drvdata(dev);
  597. nd_region = to_region(pmem);
  598. bb = &pmem->bb;
  599. bb_state = pmem->bb_state;
  600. if (is_nd_pfn(dev)) {
  601. struct nd_pfn *nd_pfn = to_nd_pfn(dev);
  602. struct nd_pfn_sb *pfn_sb = nd_pfn->pfn_sb;
  603. ndns = nd_pfn->ndns;
  604. offset = pmem->data_offset +
  605. __le32_to_cpu(pfn_sb->start_pad);
  606. end_trunc = __le32_to_cpu(pfn_sb->end_trunc);
  607. } else {
  608. ndns = to_ndns(dev);
  609. }
  610. nsio = to_nd_namespace_io(&ndns->dev);
  611. }
  612. range.start = nsio->res.start + offset;
  613. range.end = nsio->res.end - end_trunc;
  614. nvdimm_badblocks_populate(nd_region, bb, &range);
  615. if (bb_state)
  616. sysfs_notify_dirent(bb_state);
  617. }
  618. static void pmem_revalidate_region(struct device *dev)
  619. {
  620. struct pmem_device *pmem;
  621. if (is_nd_btt(dev)) {
  622. struct nd_btt *nd_btt = to_nd_btt(dev);
  623. struct btt *btt = nd_btt->btt;
  624. nvdimm_check_and_set_ro(btt->btt_disk);
  625. return;
  626. }
  627. pmem = dev_get_drvdata(dev);
  628. nvdimm_check_and_set_ro(pmem->disk);
  629. }
  630. static void nd_pmem_notify(struct device *dev, enum nvdimm_event event)
  631. {
  632. switch (event) {
  633. case NVDIMM_REVALIDATE_POISON:
  634. pmem_revalidate_poison(dev);
  635. break;
  636. case NVDIMM_REVALIDATE_REGION:
  637. pmem_revalidate_region(dev);
  638. break;
  639. default:
  640. dev_WARN_ONCE(dev, 1, "notify: unknown event: %d\n", event);
  641. break;
  642. }
  643. }
  644. MODULE_ALIAS("pmem");
  645. MODULE_ALIAS_ND_DEVICE(ND_DEVICE_NAMESPACE_IO);
  646. MODULE_ALIAS_ND_DEVICE(ND_DEVICE_NAMESPACE_PMEM);
  647. static struct nd_device_driver nd_pmem_driver = {
  648. .probe = nd_pmem_probe,
  649. .remove = nd_pmem_remove,
  650. .notify = nd_pmem_notify,
  651. .shutdown = nd_pmem_shutdown,
  652. .drv = {
  653. .name = "nd_pmem",
  654. },
  655. .type = ND_DRIVER_NAMESPACE_IO | ND_DRIVER_NAMESPACE_PMEM,
  656. };
  657. module_nd_driver(nd_pmem_driver);
  658. MODULE_AUTHOR("Ross Zwisler <ross.zwisler@linux.intel.com>");
  659. MODULE_DESCRIPTION("NVDIMM Persistent Memory Driver");
  660. MODULE_LICENSE("GPL v2");