]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - drivers/lightnvm/core.c
Merge tag 'nios2-v4.10-rc1' of git://git.kernel.org/pub/scm/linux/kernel/git/lftan...
[mirror_ubuntu-zesty-kernel.git] / drivers / lightnvm / core.c
CommitLineData
cd9e9808
MB
1/*
2 * Copyright (C) 2015 IT University of Copenhagen. All rights reserved.
3 * Initial release: Matias Bjorling <m@bjorling.me>
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License version
7 * 2 as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; see the file COPYING. If not, write to
16 * the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139,
17 * USA.
18 *
19 */
20
cd9e9808
MB
21#include <linux/list.h>
22#include <linux/types.h>
23#include <linux/sem.h>
24#include <linux/bitmap.h>
389b2a1c 25#include <linux/moduleparam.h>
cd9e9808
MB
26#include <linux/miscdevice.h>
27#include <linux/lightnvm.h>
91276162 28#include <linux/sched/sysctl.h>
cd9e9808 29
6063fe39 30static LIST_HEAD(nvm_tgt_types);
5cd90785 31static DECLARE_RWSEM(nvm_tgtt_lock);
cd9e9808
MB
32static LIST_HEAD(nvm_mgrs);
33static LIST_HEAD(nvm_devices);
34static DECLARE_RWSEM(nvm_lock);
35
b76eb20b 36struct nvm_tgt_type *nvm_find_target_type(const char *name, int lock)
6f8645cb 37{
b76eb20b 38 struct nvm_tgt_type *tmp, *tt = NULL;
6f8645cb 39
b76eb20b 40 if (lock)
5cd90785 41 down_write(&nvm_tgtt_lock);
6f8645cb 42
b76eb20b
MB
43 list_for_each_entry(tmp, &nvm_tgt_types, list)
44 if (!strcmp(name, tmp->name)) {
45 tt = tmp;
46 break;
47 }
cd9e9808 48
b76eb20b 49 if (lock)
5cd90785 50 up_write(&nvm_tgtt_lock);
b76eb20b 51 return tt;
cd9e9808 52}
b76eb20b 53EXPORT_SYMBOL(nvm_find_target_type);
cd9e9808 54
6063fe39 55int nvm_register_tgt_type(struct nvm_tgt_type *tt)
cd9e9808
MB
56{
57 int ret = 0;
58
5cd90785 59 down_write(&nvm_tgtt_lock);
b76eb20b 60 if (nvm_find_target_type(tt->name, 0))
cd9e9808
MB
61 ret = -EEXIST;
62 else
6063fe39 63 list_add(&tt->list, &nvm_tgt_types);
5cd90785 64 up_write(&nvm_tgtt_lock);
cd9e9808
MB
65
66 return ret;
67}
6063fe39 68EXPORT_SYMBOL(nvm_register_tgt_type);
cd9e9808 69
6063fe39 70void nvm_unregister_tgt_type(struct nvm_tgt_type *tt)
cd9e9808
MB
71{
72 if (!tt)
73 return;
74
75 down_write(&nvm_lock);
76 list_del(&tt->list);
77 up_write(&nvm_lock);
78}
6063fe39 79EXPORT_SYMBOL(nvm_unregister_tgt_type);
cd9e9808
MB
80
81void *nvm_dev_dma_alloc(struct nvm_dev *dev, gfp_t mem_flags,
82 dma_addr_t *dma_handler)
83{
75b85649 84 return dev->ops->dev_dma_alloc(dev, dev->dma_pool, mem_flags,
cd9e9808
MB
85 dma_handler);
86}
87EXPORT_SYMBOL(nvm_dev_dma_alloc);
88
da2d7cb8 89void nvm_dev_dma_free(struct nvm_dev *dev, void *addr, dma_addr_t dma_handler)
cd9e9808 90{
75b85649 91 dev->ops->dev_dma_free(dev->dma_pool, addr, dma_handler);
cd9e9808
MB
92}
93EXPORT_SYMBOL(nvm_dev_dma_free);
94
95static struct nvmm_type *nvm_find_mgr_type(const char *name)
96{
97 struct nvmm_type *mt;
98
99 list_for_each_entry(mt, &nvm_mgrs, list)
100 if (!strcmp(name, mt->name))
101 return mt;
102
103 return NULL;
104}
105
58eaaf9b 106static struct nvmm_type *nvm_init_mgr(struct nvm_dev *dev)
762796bc
MB
107{
108 struct nvmm_type *mt;
109 int ret;
110
111 lockdep_assert_held(&nvm_lock);
112
113 list_for_each_entry(mt, &nvm_mgrs, list) {
b7692076
MB
114 if (strncmp(dev->sb.mmtype, mt->name, NVM_MMTYPE_LEN))
115 continue;
116
762796bc
MB
117 ret = mt->register_mgr(dev);
118 if (ret < 0) {
119 pr_err("nvm: media mgr failed to init (%d) on dev %s\n",
120 ret, dev->name);
121 return NULL; /* initialization failed */
122 } else if (ret > 0)
123 return mt;
124 }
125
126 return NULL;
127}
128
cd9e9808
MB
129int nvm_register_mgr(struct nvmm_type *mt)
130{
762796bc 131 struct nvm_dev *dev;
cd9e9808
MB
132 int ret = 0;
133
134 down_write(&nvm_lock);
762796bc 135 if (nvm_find_mgr_type(mt->name)) {
cd9e9808 136 ret = -EEXIST;
762796bc
MB
137 goto finish;
138 } else {
cd9e9808 139 list_add(&mt->list, &nvm_mgrs);
762796bc
MB
140 }
141
142 /* try to register media mgr if any device have none configured */
143 list_for_each_entry(dev, &nvm_devices, devices) {
144 if (dev->mt)
145 continue;
146
147 dev->mt = nvm_init_mgr(dev);
148 }
149finish:
cd9e9808
MB
150 up_write(&nvm_lock);
151
152 return ret;
153}
154EXPORT_SYMBOL(nvm_register_mgr);
155
156void nvm_unregister_mgr(struct nvmm_type *mt)
157{
158 if (!mt)
159 return;
160
161 down_write(&nvm_lock);
162 list_del(&mt->list);
163 up_write(&nvm_lock);
164}
165EXPORT_SYMBOL(nvm_unregister_mgr);
166
167static struct nvm_dev *nvm_find_nvm_dev(const char *name)
168{
169 struct nvm_dev *dev;
170
171 list_for_each_entry(dev, &nvm_devices, devices)
172 if (!strcmp(name, dev->name))
173 return dev;
174
175 return NULL;
176}
177
333ba053
JG
178static void nvm_tgt_generic_to_addr_mode(struct nvm_tgt_dev *tgt_dev,
179 struct nvm_rq *rqd)
180{
181 struct nvm_dev *dev = tgt_dev->parent;
182 int i;
183
184 if (rqd->nr_ppas > 1) {
185 for (i = 0; i < rqd->nr_ppas; i++) {
186 rqd->ppa_list[i] = dev->mt->trans_ppa(tgt_dev,
187 rqd->ppa_list[i], TRANS_TGT_TO_DEV);
188 rqd->ppa_list[i] = generic_to_dev_addr(dev,
189 rqd->ppa_list[i]);
190 }
191 } else {
192 rqd->ppa_addr = dev->mt->trans_ppa(tgt_dev, rqd->ppa_addr,
193 TRANS_TGT_TO_DEV);
194 rqd->ppa_addr = generic_to_dev_addr(dev, rqd->ppa_addr);
195 }
196}
197
a24ba464
JG
198int nvm_set_bb_tbl(struct nvm_dev *dev, struct ppa_addr *ppas, int nr_ppas,
199 int type)
200{
201 struct nvm_rq rqd;
202 int ret;
203
204 if (nr_ppas > dev->ops->max_phys_sect) {
205 pr_err("nvm: unable to update all sysblocks atomically\n");
206 return -EINVAL;
207 }
208
209 memset(&rqd, 0, sizeof(struct nvm_rq));
210
211 nvm_set_rqd_ppalist(dev, &rqd, ppas, nr_ppas, 1);
212 nvm_generic_to_addr_mode(dev, &rqd);
213
214 ret = dev->ops->set_bb_tbl(dev, &rqd.ppa_addr, rqd.nr_ppas, type);
215 nvm_free_rqd_ppalist(dev, &rqd);
216 if (ret) {
217 pr_err("nvm: sysblk failed bb mark\n");
218 return -EINVAL;
219 }
220
221 return 0;
222}
223EXPORT_SYMBOL(nvm_set_bb_tbl);
224
333ba053
JG
225int nvm_set_tgt_bb_tbl(struct nvm_tgt_dev *tgt_dev, struct ppa_addr *ppas,
226 int nr_ppas, int type)
227{
228 struct nvm_dev *dev = tgt_dev->parent;
229 struct nvm_rq rqd;
230 int ret;
231
232 if (nr_ppas > dev->ops->max_phys_sect) {
233 pr_err("nvm: unable to update all blocks atomically\n");
234 return -EINVAL;
235 }
236
237 memset(&rqd, 0, sizeof(struct nvm_rq));
238
239 nvm_set_rqd_ppalist(dev, &rqd, ppas, nr_ppas, 1);
240 nvm_tgt_generic_to_addr_mode(tgt_dev, &rqd);
241
242 ret = dev->ops->set_bb_tbl(dev, &rqd.ppa_addr, rqd.nr_ppas, type);
243 nvm_free_rqd_ppalist(dev, &rqd);
244 if (ret) {
245 pr_err("nvm: sysblk failed bb mark\n");
246 return -EINVAL;
247 }
248
249 return 0;
250}
251EXPORT_SYMBOL(nvm_set_tgt_bb_tbl);
252
a279006a
JG
253int nvm_max_phys_sects(struct nvm_tgt_dev *tgt_dev)
254{
255 struct nvm_dev *dev = tgt_dev->parent;
256
257 return dev->ops->max_phys_sect;
258}
259EXPORT_SYMBOL(nvm_max_phys_sects);
260
8e53624d 261int nvm_submit_io(struct nvm_tgt_dev *tgt_dev, struct nvm_rq *rqd)
cd9e9808 262{
8e53624d
JG
263 struct nvm_dev *dev = tgt_dev->parent;
264
265 return dev->mt->submit_io(tgt_dev, rqd);
cd9e9808
MB
266}
267EXPORT_SYMBOL(nvm_submit_io);
268
8e53624d 269int nvm_erase_blk(struct nvm_tgt_dev *tgt_dev, struct ppa_addr *p, int flags)
cd9e9808 270{
8e53624d
JG
271 struct nvm_dev *dev = tgt_dev->parent;
272
273 return dev->mt->erase_blk(tgt_dev, p, flags);
cd9e9808
MB
274}
275EXPORT_SYMBOL(nvm_erase_blk);
276
da2d7cb8 277int nvm_get_l2p_tbl(struct nvm_tgt_dev *tgt_dev, u64 slba, u32 nlb,
959e911b
JG
278 nvm_l2p_update_fn *update_l2p, void *priv)
279{
da2d7cb8
JG
280 struct nvm_dev *dev = tgt_dev->parent;
281
959e911b
JG
282 if (!dev->ops->get_l2p_tbl)
283 return 0;
284
285 return dev->ops->get_l2p_tbl(dev, slba, nlb, update_l2p, priv);
286}
287EXPORT_SYMBOL(nvm_get_l2p_tbl);
288
da2d7cb8 289int nvm_get_area(struct nvm_tgt_dev *tgt_dev, sector_t *lba, sector_t len)
959e911b 290{
da2d7cb8
JG
291 struct nvm_dev *dev = tgt_dev->parent;
292
959e911b
JG
293 return dev->mt->get_area(dev, lba, len);
294}
295EXPORT_SYMBOL(nvm_get_area);
296
da2d7cb8 297void nvm_put_area(struct nvm_tgt_dev *tgt_dev, sector_t lba)
959e911b 298{
da2d7cb8
JG
299 struct nvm_dev *dev = tgt_dev->parent;
300
959e911b
JG
301 dev->mt->put_area(dev, lba);
302}
303EXPORT_SYMBOL(nvm_put_area);
304
069368e9
MB
305void nvm_addr_to_generic_mode(struct nvm_dev *dev, struct nvm_rq *rqd)
306{
307 int i;
308
6d5be959
JG
309 if (rqd->nr_ppas > 1) {
310 for (i = 0; i < rqd->nr_ppas; i++)
069368e9
MB
311 rqd->ppa_list[i] = dev_to_generic_addr(dev,
312 rqd->ppa_list[i]);
313 } else {
314 rqd->ppa_addr = dev_to_generic_addr(dev, rqd->ppa_addr);
315 }
316}
317EXPORT_SYMBOL(nvm_addr_to_generic_mode);
318
319void nvm_generic_to_addr_mode(struct nvm_dev *dev, struct nvm_rq *rqd)
320{
321 int i;
322
6d5be959
JG
323 if (rqd->nr_ppas > 1) {
324 for (i = 0; i < rqd->nr_ppas; i++)
069368e9
MB
325 rqd->ppa_list[i] = generic_to_dev_addr(dev,
326 rqd->ppa_list[i]);
327 } else {
328 rqd->ppa_addr = generic_to_dev_addr(dev, rqd->ppa_addr);
329 }
330}
331EXPORT_SYMBOL(nvm_generic_to_addr_mode);
332
abd805ec 333int nvm_set_rqd_ppalist(struct nvm_dev *dev, struct nvm_rq *rqd,
8680f165 334 const struct ppa_addr *ppas, int nr_ppas, int vblk)
069368e9 335{
8e79b5cb 336 struct nvm_geo *geo = &dev->geo;
abd805ec 337 int i, plane_cnt, pl_idx;
8680f165 338 struct ppa_addr ppa;
abd805ec 339
8e79b5cb 340 if ((!vblk || geo->plane_mode == NVM_PLANE_SINGLE) && nr_ppas == 1) {
6d5be959 341 rqd->nr_ppas = nr_ppas;
abd805ec 342 rqd->ppa_addr = ppas[0];
069368e9 343
069368e9 344 return 0;
abd805ec 345 }
069368e9 346
6d5be959 347 rqd->nr_ppas = nr_ppas;
abd805ec
MB
348 rqd->ppa_list = nvm_dev_dma_alloc(dev, GFP_KERNEL, &rqd->dma_ppa_list);
349 if (!rqd->ppa_list) {
350 pr_err("nvm: failed to allocate dma memory\n");
351 return -ENOMEM;
352 }
353
5ebc7d9f
MB
354 if (!vblk) {
355 for (i = 0; i < nr_ppas; i++)
356 rqd->ppa_list[i] = ppas[i];
357 } else {
8e79b5cb 358 plane_cnt = geo->plane_mode;
6d5be959 359 rqd->nr_ppas *= plane_cnt;
5ebc7d9f 360
556755e9 361 for (i = 0; i < nr_ppas; i++) {
5ebc7d9f 362 for (pl_idx = 0; pl_idx < plane_cnt; pl_idx++) {
8680f165
MB
363 ppa = ppas[i];
364 ppa.g.pl = pl_idx;
365 rqd->ppa_list[(pl_idx * nr_ppas) + i] = ppa;
5ebc7d9f 366 }
069368e9
MB
367 }
368 }
369
abd805ec
MB
370 return 0;
371}
372EXPORT_SYMBOL(nvm_set_rqd_ppalist);
373
374void nvm_free_rqd_ppalist(struct nvm_dev *dev, struct nvm_rq *rqd)
375{
376 if (!rqd->ppa_list)
377 return;
378
379 nvm_dev_dma_free(dev, rqd->ppa_list, rqd->dma_ppa_list);
380}
381EXPORT_SYMBOL(nvm_free_rqd_ppalist);
382
bb314979
JG
383int nvm_erase_ppa(struct nvm_dev *dev, struct ppa_addr *ppas, int nr_ppas,
384 int flags)
abd805ec
MB
385{
386 struct nvm_rq rqd;
387 int ret;
388
389 if (!dev->ops->erase_block)
390 return 0;
391
392 memset(&rqd, 0, sizeof(struct nvm_rq));
393
5ebc7d9f 394 ret = nvm_set_rqd_ppalist(dev, &rqd, ppas, nr_ppas, 1);
abd805ec
MB
395 if (ret)
396 return ret;
397
069368e9
MB
398 nvm_generic_to_addr_mode(dev, &rqd);
399
bb314979
JG
400 rqd.flags = flags;
401
069368e9
MB
402 ret = dev->ops->erase_block(dev, &rqd);
403
abd805ec 404 nvm_free_rqd_ppalist(dev, &rqd);
069368e9
MB
405
406 return ret;
407}
408EXPORT_SYMBOL(nvm_erase_ppa);
409
91276162
MB
410void nvm_end_io(struct nvm_rq *rqd, int error)
411{
72d256ec
MB
412 rqd->error = error;
413 rqd->end_io(rqd);
91276162
MB
414}
415EXPORT_SYMBOL(nvm_end_io);
416
09719b62 417static void nvm_end_io_sync(struct nvm_rq *rqd)
91276162
MB
418{
419 struct completion *waiting = rqd->wait;
420
421 rqd->wait = NULL;
422
423 complete(waiting);
424}
425
d9e46d5d 426static int __nvm_submit_ppa(struct nvm_dev *dev, struct nvm_rq *rqd, int opcode,
1145e635 427 int flags, void *buf, int len)
09719b62
MB
428{
429 DECLARE_COMPLETION_ONSTACK(wait);
09719b62
MB
430 struct bio *bio;
431 int ret;
432 unsigned long hang_check;
433
434 bio = bio_map_kern(dev->q, buf, len, GFP_KERNEL);
435 if (IS_ERR_OR_NULL(bio))
436 return -ENOMEM;
437
1145e635 438 nvm_generic_to_addr_mode(dev, rqd);
09719b62 439
8e53624d 440 rqd->dev = NULL;
1145e635
MB
441 rqd->opcode = opcode;
442 rqd->flags = flags;
443 rqd->bio = bio;
444 rqd->wait = &wait;
445 rqd->end_io = nvm_end_io_sync;
09719b62 446
1145e635 447 ret = dev->ops->submit_io(dev, rqd);
ecfb40c6 448 if (ret) {
ecfb40c6
MB
449 bio_put(bio);
450 return ret;
451 }
09719b62
MB
452
453 /* Prevent hang_check timer from firing at us during very long I/O */
454 hang_check = sysctl_hung_task_timeout_secs;
455 if (hang_check)
12624af2
MB
456 while (!wait_for_completion_io_timeout(&wait,
457 hang_check * (HZ/2)))
458 ;
09719b62
MB
459 else
460 wait_for_completion_io(&wait);
461
1145e635
MB
462 return rqd->error;
463}
464
465/**
466 * nvm_submit_ppa_list - submit user-defined ppa list to device. The user must
467 * take to free ppa list if necessary.
468 * @dev: device
469 * @ppa_list: user created ppa_list
470 * @nr_ppas: length of ppa_list
471 * @opcode: device opcode
472 * @flags: device flags
473 * @buf: data buffer
474 * @len: data buffer length
475 */
476int nvm_submit_ppa_list(struct nvm_dev *dev, struct ppa_addr *ppa_list,
477 int nr_ppas, int opcode, int flags, void *buf, int len)
478{
479 struct nvm_rq rqd;
480
481 if (dev->ops->max_phys_sect < nr_ppas)
482 return -EINVAL;
483
484 memset(&rqd, 0, sizeof(struct nvm_rq));
485
6d5be959 486 rqd.nr_ppas = nr_ppas;
1145e635
MB
487 if (nr_ppas > 1)
488 rqd.ppa_list = ppa_list;
489 else
490 rqd.ppa_addr = ppa_list[0];
491
492 return __nvm_submit_ppa(dev, &rqd, opcode, flags, buf, len);
493}
494EXPORT_SYMBOL(nvm_submit_ppa_list);
495
496/**
497 * nvm_submit_ppa - submit PPAs to device. PPAs will automatically be unfolded
498 * as single, dual, quad plane PPAs depending on device type.
499 * @dev: device
500 * @ppa: user created ppa_list
501 * @nr_ppas: length of ppa_list
502 * @opcode: device opcode
503 * @flags: device flags
504 * @buf: data buffer
505 * @len: data buffer length
506 */
507int nvm_submit_ppa(struct nvm_dev *dev, struct ppa_addr *ppa, int nr_ppas,
508 int opcode, int flags, void *buf, int len)
509{
510 struct nvm_rq rqd;
511 int ret;
512
513 memset(&rqd, 0, sizeof(struct nvm_rq));
5ebc7d9f 514 ret = nvm_set_rqd_ppalist(dev, &rqd, ppa, nr_ppas, 1);
1145e635
MB
515 if (ret)
516 return ret;
517
518 ret = __nvm_submit_ppa(dev, &rqd, opcode, flags, buf, len);
519
09719b62
MB
520 nvm_free_rqd_ppalist(dev, &rqd);
521
1145e635 522 return ret;
09719b62
MB
523}
524EXPORT_SYMBOL(nvm_submit_ppa);
525
22e8c976
MB
526/*
527 * folds a bad block list from its plane representation to its virtual
528 * block representation. The fold is done in place and reduced size is
529 * returned.
530 *
531 * If any of the planes status are bad or grown bad block, the virtual block
532 * is marked bad. If not bad, the first plane state acts as the block state.
533 */
534int nvm_bb_tbl_fold(struct nvm_dev *dev, u8 *blks, int nr_blks)
535{
8e79b5cb 536 struct nvm_geo *geo = &dev->geo;
22e8c976
MB
537 int blk, offset, pl, blktype;
538
8e79b5cb 539 if (nr_blks != geo->blks_per_lun * geo->plane_mode)
22e8c976
MB
540 return -EINVAL;
541
8e79b5cb
JG
542 for (blk = 0; blk < geo->blks_per_lun; blk++) {
543 offset = blk * geo->plane_mode;
22e8c976
MB
544 blktype = blks[offset];
545
546 /* Bad blocks on any planes take precedence over other types */
8e79b5cb 547 for (pl = 0; pl < geo->plane_mode; pl++) {
22e8c976
MB
548 if (blks[offset + pl] &
549 (NVM_BLK_T_BAD|NVM_BLK_T_GRWN_BAD)) {
550 blktype = blks[offset + pl];
551 break;
552 }
553 }
554
555 blks[blk] = blktype;
556 }
557
8e79b5cb 558 return geo->blks_per_lun;
22e8c976
MB
559}
560EXPORT_SYMBOL(nvm_bb_tbl_fold);
561
e11903f5
MB
562int nvm_get_bb_tbl(struct nvm_dev *dev, struct ppa_addr ppa, u8 *blks)
563{
564 ppa = generic_to_dev_addr(dev, ppa);
565
566 return dev->ops->get_bb_tbl(dev, ppa, blks);
567}
568EXPORT_SYMBOL(nvm_get_bb_tbl);
569
333ba053
JG
570int nvm_get_tgt_bb_tbl(struct nvm_tgt_dev *tgt_dev, struct ppa_addr ppa,
571 u8 *blks)
572{
573 struct nvm_dev *dev = tgt_dev->parent;
574
575 ppa = dev->mt->trans_ppa(tgt_dev, ppa, TRANS_TGT_TO_DEV);
576 return nvm_get_bb_tbl(dev, ppa, blks);
577}
578EXPORT_SYMBOL(nvm_get_tgt_bb_tbl);
579
ca5927e7
MB
580static int nvm_init_slc_tbl(struct nvm_dev *dev, struct nvm_id_group *grp)
581{
8e79b5cb 582 struct nvm_geo *geo = &dev->geo;
ca5927e7
MB
583 int i;
584
8e79b5cb 585 dev->lps_per_blk = geo->pgs_per_blk;
ca5927e7
MB
586 dev->lptbl = kcalloc(dev->lps_per_blk, sizeof(int), GFP_KERNEL);
587 if (!dev->lptbl)
588 return -ENOMEM;
589
590 /* Just a linear array */
591 for (i = 0; i < dev->lps_per_blk; i++)
592 dev->lptbl[i] = i;
593
594 return 0;
595}
596
597static int nvm_init_mlc_tbl(struct nvm_dev *dev, struct nvm_id_group *grp)
598{
599 int i, p;
600 struct nvm_id_lp_mlc *mlc = &grp->lptbl.mlc;
601
602 if (!mlc->num_pairs)
603 return 0;
604
605 dev->lps_per_blk = mlc->num_pairs;
606 dev->lptbl = kcalloc(dev->lps_per_blk, sizeof(int), GFP_KERNEL);
607 if (!dev->lptbl)
608 return -ENOMEM;
609
610 /* The lower page table encoding consists of a list of bytes, where each
611 * has a lower and an upper half. The first half byte maintains the
612 * increment value and every value after is an offset added to the
12624af2
MB
613 * previous incrementation value
614 */
ca5927e7
MB
615 dev->lptbl[0] = mlc->pairs[0] & 0xF;
616 for (i = 1; i < dev->lps_per_blk; i++) {
617 p = mlc->pairs[i >> 1];
618 if (i & 0x1) /* upper */
619 dev->lptbl[i] = dev->lptbl[i - 1] + ((p & 0xF0) >> 4);
620 else /* lower */
621 dev->lptbl[i] = dev->lptbl[i - 1] + (p & 0xF);
622 }
623
624 return 0;
625}
626
cd9e9808
MB
627static int nvm_core_init(struct nvm_dev *dev)
628{
629 struct nvm_id *id = &dev->identity;
630 struct nvm_id_group *grp = &id->groups[0];
8e79b5cb 631 struct nvm_geo *geo = &dev->geo;
7f7c5d03 632 int ret;
cd9e9808 633
8e79b5cb
JG
634 /* Whole device values */
635 geo->nr_chnls = grp->num_ch;
636 geo->luns_per_chnl = grp->num_lun;
637
638 /* Generic device values */
639 geo->pgs_per_blk = grp->num_pg;
640 geo->blks_per_lun = grp->num_blk;
641 geo->nr_planes = grp->num_pln;
642 geo->fpg_size = grp->fpg_sz;
643 geo->pfpg_size = grp->fpg_sz * grp->num_pln;
644 geo->sec_size = grp->csecs;
645 geo->oob_size = grp->sos;
646 geo->sec_per_pg = grp->fpg_sz / grp->csecs;
647 geo->mccap = grp->mccap;
648 memcpy(&geo->ppaf, &id->ppaf, sizeof(struct nvm_addr_format));
649
650 geo->plane_mode = NVM_PLANE_SINGLE;
651 geo->max_rq_size = dev->ops->max_phys_sect * geo->sec_size;
cd9e9808
MB
652
653 if (grp->mpos & 0x020202)
8e79b5cb 654 geo->plane_mode = NVM_PLANE_DOUBLE;
cd9e9808 655 if (grp->mpos & 0x040404)
8e79b5cb 656 geo->plane_mode = NVM_PLANE_QUAD;
cd9e9808 657
7f7c5d03
MB
658 if (grp->mtype != 0) {
659 pr_err("nvm: memory type not supported\n");
660 return -EINVAL;
661 }
662
cd9e9808 663 /* calculated values */
8e79b5cb
JG
664 geo->sec_per_pl = geo->sec_per_pg * geo->nr_planes;
665 geo->sec_per_blk = geo->sec_per_pl * geo->pgs_per_blk;
666 geo->sec_per_lun = geo->sec_per_blk * geo->blks_per_lun;
667 geo->nr_luns = geo->luns_per_chnl * geo->nr_chnls;
cd9e9808 668
8e79b5cb
JG
669 dev->total_secs = geo->nr_luns * geo->sec_per_lun;
670 dev->lun_map = kcalloc(BITS_TO_LONGS(geo->nr_luns),
da1e2849
WT
671 sizeof(unsigned long), GFP_KERNEL);
672 if (!dev->lun_map)
673 return -ENOMEM;
7f7c5d03
MB
674
675 switch (grp->fmtype) {
676 case NVM_ID_FMTYPE_SLC:
677 if (nvm_init_slc_tbl(dev, grp)) {
678 ret = -ENOMEM;
679 goto err_fmtype;
680 }
681 break;
682 case NVM_ID_FMTYPE_MLC:
683 if (nvm_init_mlc_tbl(dev, grp)) {
684 ret = -ENOMEM;
685 goto err_fmtype;
686 }
687 break;
688 default:
689 pr_err("nvm: flash type not supported\n");
690 ret = -EINVAL;
691 goto err_fmtype;
692 }
693
e3eb3799 694 mutex_init(&dev->mlock);
4c9dacb8 695 spin_lock_init(&dev->lock);
cd9e9808 696
8e79b5cb 697 blk_queue_logical_block_size(dev->q, geo->sec_size);
ac81bfa9 698
cd9e9808 699 return 0;
7f7c5d03
MB
700err_fmtype:
701 kfree(dev->lun_map);
702 return ret;
cd9e9808
MB
703}
704
976bdfca
MB
705static void nvm_free_mgr(struct nvm_dev *dev)
706{
976bdfca
MB
707 if (!dev->mt)
708 return;
709
976bdfca
MB
710 dev->mt->unregister_mgr(dev);
711 dev->mt = NULL;
712}
713
40267efd 714void nvm_free(struct nvm_dev *dev)
cd9e9808
MB
715{
716 if (!dev)
717 return;
718
976bdfca 719 nvm_free_mgr(dev);
ca5927e7 720
40267efd
SL
721 if (dev->dma_pool)
722 dev->ops->destroy_dma_pool(dev->dma_pool);
723
ca5927e7 724 kfree(dev->lptbl);
7f7c5d03 725 kfree(dev->lun_map);
40267efd 726 kfree(dev);
cd9e9808
MB
727}
728
729static int nvm_init(struct nvm_dev *dev)
730{
8e79b5cb 731 struct nvm_geo *geo = &dev->geo;
480fc0db 732 int ret = -EINVAL;
cd9e9808
MB
733
734 if (!dev->q || !dev->ops)
480fc0db 735 return ret;
cd9e9808 736
16f26c3a 737 if (dev->ops->identity(dev, &dev->identity)) {
cd9e9808 738 pr_err("nvm: device could not be identified\n");
cd9e9808
MB
739 goto err;
740 }
741
742 pr_debug("nvm: ver:%x nvm_vendor:%x groups:%u\n",
743 dev->identity.ver_id, dev->identity.vmnt,
744 dev->identity.cgrps);
745
746 if (dev->identity.ver_id != 1) {
747 pr_err("nvm: device not supported by kernel.");
748 goto err;
749 }
750
751 if (dev->identity.cgrps != 1) {
752 pr_err("nvm: only one group configuration supported.");
753 goto err;
754 }
755
756 ret = nvm_core_init(dev);
757 if (ret) {
758 pr_err("nvm: could not initialize core structures.\n");
759 goto err;
760 }
761
cd9e9808 762 pr_info("nvm: registered %s [%u/%u/%u/%u/%u/%u]\n",
8e79b5cb
JG
763 dev->name, geo->sec_per_pg, geo->nr_planes,
764 geo->pgs_per_blk, geo->blks_per_lun,
765 geo->nr_luns, geo->nr_chnls);
cd9e9808
MB
766 return 0;
767err:
cd9e9808
MB
768 pr_err("nvm: failed to initialize nvm\n");
769 return ret;
770}
771
b0b4e09c 772struct nvm_dev *nvm_alloc_dev(int node)
cd9e9808 773{
b0b4e09c 774 return kzalloc_node(sizeof(struct nvm_dev), GFP_KERNEL, node);
cd9e9808 775}
b0b4e09c 776EXPORT_SYMBOL(nvm_alloc_dev);
cd9e9808 777
b0b4e09c 778int nvm_register(struct nvm_dev *dev)
cd9e9808 779{
cd9e9808
MB
780 int ret;
781
cd9e9808
MB
782 ret = nvm_init(dev);
783 if (ret)
784 goto err_init;
785
d160147b
WT
786 if (dev->ops->max_phys_sect > 256) {
787 pr_info("nvm: max sectors supported is 256.\n");
788 ret = -EINVAL;
789 goto err_init;
790 }
791
cd9e9808 792 if (dev->ops->max_phys_sect > 1) {
75b85649
JG
793 dev->dma_pool = dev->ops->create_dma_pool(dev, "ppalist");
794 if (!dev->dma_pool) {
795 pr_err("nvm: could not create dma pool\n");
93e70c1f
MB
796 ret = -ENOMEM;
797 goto err_init;
cd9e9808 798 }
cd9e9808
MB
799 }
800
bf643185
MB
801 if (dev->identity.cap & NVM_ID_DCAP_BBLKMGMT) {
802 ret = nvm_get_sysblock(dev, &dev->sb);
803 if (!ret)
804 pr_err("nvm: device not initialized.\n");
805 else if (ret < 0)
806 pr_err("nvm: err (%d) on device initialization\n", ret);
807 }
b7692076 808
762796bc 809 /* register device with a supported media manager */
edad2e66 810 down_write(&nvm_lock);
b7692076
MB
811 if (ret > 0)
812 dev->mt = nvm_init_mgr(dev);
edad2e66
MB
813 list_add(&dev->devices, &nvm_devices);
814 up_write(&nvm_lock);
815
cd9e9808
MB
816 return 0;
817err_init:
da1e2849 818 kfree(dev->lun_map);
cd9e9808
MB
819 return ret;
820}
821EXPORT_SYMBOL(nvm_register);
822
b0b4e09c 823void nvm_unregister(struct nvm_dev *dev)
cd9e9808 824{
d0a712ce 825 down_write(&nvm_lock);
cd9e9808
MB
826 list_del(&dev->devices);
827 up_write(&nvm_lock);
c1480ad5 828
3dc87dd0 829 nvm_free(dev);
cd9e9808
MB
830}
831EXPORT_SYMBOL(nvm_unregister);
832
cd9e9808
MB
833static int __nvm_configure_create(struct nvm_ioctl_create *create)
834{
835 struct nvm_dev *dev;
836 struct nvm_ioctl_create_simple *s;
837
d0a712ce 838 down_write(&nvm_lock);
cd9e9808 839 dev = nvm_find_nvm_dev(create->dev);
d0a712ce 840 up_write(&nvm_lock);
b76eb20b 841
cd9e9808
MB
842 if (!dev) {
843 pr_err("nvm: device not found\n");
844 return -EINVAL;
845 }
846
b76eb20b
MB
847 if (!dev->mt) {
848 pr_info("nvm: device has no media manager registered.\n");
849 return -ENODEV;
850 }
851
cd9e9808
MB
852 if (create->conf.type != NVM_CONFIG_TYPE_SIMPLE) {
853 pr_err("nvm: config type not valid\n");
854 return -EINVAL;
855 }
856 s = &create->conf.s;
857
8e79b5cb 858 if (s->lun_begin > s->lun_end || s->lun_end > dev->geo.nr_luns) {
cd9e9808 859 pr_err("nvm: lun out of bound (%u:%u > %u)\n",
8e79b5cb 860 s->lun_begin, s->lun_end, dev->geo.nr_luns);
cd9e9808
MB
861 return -EINVAL;
862 }
863
b76eb20b 864 return dev->mt->create_tgt(dev, create);
cd9e9808
MB
865}
866
cd9e9808
MB
867static long nvm_ioctl_info(struct file *file, void __user *arg)
868{
869 struct nvm_ioctl_info *info;
870 struct nvm_tgt_type *tt;
871 int tgt_iter = 0;
872
873 if (!capable(CAP_SYS_ADMIN))
874 return -EPERM;
875
876 info = memdup_user(arg, sizeof(struct nvm_ioctl_info));
877 if (IS_ERR(info))
878 return -EFAULT;
879
880 info->version[0] = NVM_VERSION_MAJOR;
881 info->version[1] = NVM_VERSION_MINOR;
882 info->version[2] = NVM_VERSION_PATCH;
883
884 down_write(&nvm_lock);
6063fe39 885 list_for_each_entry(tt, &nvm_tgt_types, list) {
cd9e9808
MB
886 struct nvm_ioctl_info_tgt *tgt = &info->tgts[tgt_iter];
887
888 tgt->version[0] = tt->version[0];
889 tgt->version[1] = tt->version[1];
890 tgt->version[2] = tt->version[2];
891 strncpy(tgt->tgtname, tt->name, NVM_TTYPE_NAME_MAX);
892
893 tgt_iter++;
894 }
895
896 info->tgtsize = tgt_iter;
897 up_write(&nvm_lock);
898
76e25081
SM
899 if (copy_to_user(arg, info, sizeof(struct nvm_ioctl_info))) {
900 kfree(info);
cd9e9808 901 return -EFAULT;
76e25081 902 }
cd9e9808
MB
903
904 kfree(info);
905 return 0;
906}
907
908static long nvm_ioctl_get_devices(struct file *file, void __user *arg)
909{
910 struct nvm_ioctl_get_devices *devices;
911 struct nvm_dev *dev;
912 int i = 0;
913
914 if (!capable(CAP_SYS_ADMIN))
915 return -EPERM;
916
917 devices = kzalloc(sizeof(struct nvm_ioctl_get_devices), GFP_KERNEL);
918 if (!devices)
919 return -ENOMEM;
920
921 down_write(&nvm_lock);
922 list_for_each_entry(dev, &nvm_devices, devices) {
923 struct nvm_ioctl_device_info *info = &devices->info[i];
924
925 sprintf(info->devname, "%s", dev->name);
926 if (dev->mt) {
927 info->bmversion[0] = dev->mt->version[0];
928 info->bmversion[1] = dev->mt->version[1];
929 info->bmversion[2] = dev->mt->version[2];
930 sprintf(info->bmname, "%s", dev->mt->name);
931 } else {
932 sprintf(info->bmname, "none");
933 }
934
935 i++;
936 if (i > 31) {
937 pr_err("nvm: max 31 devices can be reported.\n");
938 break;
939 }
940 }
941 up_write(&nvm_lock);
942
943 devices->nr_devices = i;
944
76e25081
SM
945 if (copy_to_user(arg, devices,
946 sizeof(struct nvm_ioctl_get_devices))) {
947 kfree(devices);
cd9e9808 948 return -EFAULT;
76e25081 949 }
cd9e9808
MB
950
951 kfree(devices);
952 return 0;
953}
954
955static long nvm_ioctl_dev_create(struct file *file, void __user *arg)
956{
957 struct nvm_ioctl_create create;
958
959 if (!capable(CAP_SYS_ADMIN))
960 return -EPERM;
961
962 if (copy_from_user(&create, arg, sizeof(struct nvm_ioctl_create)))
963 return -EFAULT;
964
965 create.dev[DISK_NAME_LEN - 1] = '\0';
966 create.tgttype[NVM_TTYPE_NAME_MAX - 1] = '\0';
967 create.tgtname[DISK_NAME_LEN - 1] = '\0';
968
969 if (create.flags != 0) {
970 pr_err("nvm: no flags supported\n");
971 return -EINVAL;
972 }
973
974 return __nvm_configure_create(&create);
975}
976
977static long nvm_ioctl_dev_remove(struct file *file, void __user *arg)
978{
979 struct nvm_ioctl_remove remove;
b76eb20b
MB
980 struct nvm_dev *dev;
981 int ret = 0;
cd9e9808
MB
982
983 if (!capable(CAP_SYS_ADMIN))
984 return -EPERM;
985
986 if (copy_from_user(&remove, arg, sizeof(struct nvm_ioctl_remove)))
987 return -EFAULT;
988
989 remove.tgtname[DISK_NAME_LEN - 1] = '\0';
990
991 if (remove.flags != 0) {
992 pr_err("nvm: no flags supported\n");
993 return -EINVAL;
994 }
995
b76eb20b
MB
996 list_for_each_entry(dev, &nvm_devices, devices) {
997 ret = dev->mt->remove_tgt(dev, &remove);
998 if (!ret)
999 break;
1000 }
1001
1002 return ret;
cd9e9808
MB
1003}
1004
55696154
MB
1005static void nvm_setup_nvm_sb_info(struct nvm_sb_info *info)
1006{
1007 info->seqnr = 1;
1008 info->erase_cnt = 0;
1009 info->version = 1;
1010}
1011
1012static long __nvm_ioctl_dev_init(struct nvm_ioctl_dev_init *init)
1013{
1014 struct nvm_dev *dev;
1015 struct nvm_sb_info info;
b7692076 1016 int ret;
55696154
MB
1017
1018 down_write(&nvm_lock);
1019 dev = nvm_find_nvm_dev(init->dev);
1020 up_write(&nvm_lock);
1021 if (!dev) {
1022 pr_err("nvm: device not found\n");
1023 return -EINVAL;
1024 }
1025
1026 nvm_setup_nvm_sb_info(&info);
1027
1028 strncpy(info.mmtype, init->mmtype, NVM_MMTYPE_LEN);
1029 info.fs_ppa.ppa = -1;
1030
bf643185
MB
1031 if (dev->identity.cap & NVM_ID_DCAP_BBLKMGMT) {
1032 ret = nvm_init_sysblock(dev, &info);
1033 if (ret)
1034 return ret;
1035 }
b7692076
MB
1036
1037 memcpy(&dev->sb, &info, sizeof(struct nvm_sb_info));
1038
1039 down_write(&nvm_lock);
1040 dev->mt = nvm_init_mgr(dev);
1041 up_write(&nvm_lock);
1042
1043 return 0;
55696154
MB
1044}
1045
1046static long nvm_ioctl_dev_init(struct file *file, void __user *arg)
1047{
1048 struct nvm_ioctl_dev_init init;
1049
1050 if (!capable(CAP_SYS_ADMIN))
1051 return -EPERM;
1052
1053 if (copy_from_user(&init, arg, sizeof(struct nvm_ioctl_dev_init)))
1054 return -EFAULT;
1055
1056 if (init.flags != 0) {
1057 pr_err("nvm: no flags supported\n");
1058 return -EINVAL;
1059 }
1060
1061 init.dev[DISK_NAME_LEN - 1] = '\0';
1062
1063 return __nvm_ioctl_dev_init(&init);
1064}
1065
8b4970c4
MB
1066static long nvm_ioctl_dev_factory(struct file *file, void __user *arg)
1067{
1068 struct nvm_ioctl_dev_factory fact;
1069 struct nvm_dev *dev;
1070
1071 if (!capable(CAP_SYS_ADMIN))
1072 return -EPERM;
1073
1074 if (copy_from_user(&fact, arg, sizeof(struct nvm_ioctl_dev_factory)))
1075 return -EFAULT;
1076
1077 fact.dev[DISK_NAME_LEN - 1] = '\0';
1078
1079 if (fact.flags & ~(NVM_FACTORY_NR_BITS - 1))
1080 return -EINVAL;
1081
1082 down_write(&nvm_lock);
1083 dev = nvm_find_nvm_dev(fact.dev);
1084 up_write(&nvm_lock);
1085 if (!dev) {
1086 pr_err("nvm: device not found\n");
1087 return -EINVAL;
1088 }
1089
976bdfca 1090 nvm_free_mgr(dev);
8b4970c4 1091
bf643185
MB
1092 if (dev->identity.cap & NVM_ID_DCAP_BBLKMGMT)
1093 return nvm_dev_factory(dev, fact.flags);
1094
1095 return 0;
8b4970c4
MB
1096}
1097
cd9e9808
MB
1098static long nvm_ctl_ioctl(struct file *file, uint cmd, unsigned long arg)
1099{
1100 void __user *argp = (void __user *)arg;
1101
1102 switch (cmd) {
1103 case NVM_INFO:
1104 return nvm_ioctl_info(file, argp);
1105 case NVM_GET_DEVICES:
1106 return nvm_ioctl_get_devices(file, argp);
1107 case NVM_DEV_CREATE:
1108 return nvm_ioctl_dev_create(file, argp);
1109 case NVM_DEV_REMOVE:
1110 return nvm_ioctl_dev_remove(file, argp);
55696154
MB
1111 case NVM_DEV_INIT:
1112 return nvm_ioctl_dev_init(file, argp);
8b4970c4
MB
1113 case NVM_DEV_FACTORY:
1114 return nvm_ioctl_dev_factory(file, argp);
cd9e9808
MB
1115 }
1116 return 0;
1117}
1118
1119static const struct file_operations _ctl_fops = {
1120 .open = nonseekable_open,
1121 .unlocked_ioctl = nvm_ctl_ioctl,
1122 .owner = THIS_MODULE,
1123 .llseek = noop_llseek,
1124};
1125
1126static struct miscdevice _nvm_misc = {
1127 .minor = MISC_DYNAMIC_MINOR,
1128 .name = "lightnvm",
1129 .nodename = "lightnvm/control",
1130 .fops = &_ctl_fops,
1131};
389b2a1c 1132builtin_misc_device(_nvm_misc);