drivers/lightnvm/core.c

   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
  21 #include <linux/blkdev.h>
  22 #include <linux/blk-mq.h>
  23 #include <linux/list.h>
  24 #include <linux/types.h>
  25 #include <linux/sem.h>
  26 #include <linux/bitmap.h>
  27 #include <linux/module.h>
  28 #include <linux/miscdevice.h>
  29 #include <linux/lightnvm.h>
  30 #include <linux/sched/sysctl.h>
  31 #include <uapi/linux/lightnvm.h>
  32
  33 static LIST_HEAD(nvm_tgt_types);
  34 static LIST_HEAD(nvm_mgrs);
  35 static LIST_HEAD(nvm_devices);
  36 static LIST_HEAD(nvm_targets);
  37 static DECLARE_RWSEM(nvm_lock);
  38
  39 static struct nvm_target *nvm_find_target(const char *name)
  40 {
  41         struct nvm_target *tgt;
  42
  43         list_for_each_entry(tgt, &nvm_targets, list)
  44                 if (!strcmp(name, tgt->disk->disk_name))
  45                         return tgt;
  46
  47         return NULL;
  48 }
  49
  50 static struct nvm_tgt_type *nvm_find_target_type(const char *name)
  51 {
  52         struct nvm_tgt_type *tt;
  53
  54         list_for_each_entry(tt, &nvm_tgt_types, list)
  55                 if (!strcmp(name, tt->name))
  56                         return tt;
  57
  58         return NULL;
  59 }
  60
  61 int nvm_register_tgt_type(struct nvm_tgt_type *tt)
  62 {
  63         int ret = 0;
  64
  65         down_write(&nvm_lock);
  66         if (nvm_find_target_type(tt->name))
  67                 ret = -EEXIST;
  68         else
  69                 list_add(&tt->list, &nvm_tgt_types);
  70         up_write(&nvm_lock);
  71
  72         return ret;
  73 }
  74 EXPORT_SYMBOL(nvm_register_tgt_type);
  75
  76 void nvm_unregister_tgt_type(struct nvm_tgt_type *tt)
  77 {
  78         if (!tt)
  79                 return;
  80
  81         down_write(&nvm_lock);
  82         list_del(&tt->list);
  83         up_write(&nvm_lock);
  84 }
  85 EXPORT_SYMBOL(nvm_unregister_tgt_type);
  86
  87 void *nvm_dev_dma_alloc(struct nvm_dev *dev, gfp_t mem_flags,
  88                                                         dma_addr_t *dma_handler)
  89 {
  90         return dev->ops->dev_dma_alloc(dev, dev->dma_pool, mem_flags,
  91                                                                 dma_handler);
  92 }
  93 EXPORT_SYMBOL(nvm_dev_dma_alloc);
  94
  95 void nvm_dev_dma_free(struct nvm_dev *dev, void *addr,
  96                                                         dma_addr_t dma_handler)
  97 {
  98         dev->ops->dev_dma_free(dev->dma_pool, addr, dma_handler);
  99 }
 100 EXPORT_SYMBOL(nvm_dev_dma_free);
 101
 102 static struct nvmm_type *nvm_find_mgr_type(const char *name)
 103 {
 104         struct nvmm_type *mt;
 105
 106         list_for_each_entry(mt, &nvm_mgrs, list)
 107                 if (!strcmp(name, mt->name))
 108                         return mt;
 109
 110         return NULL;
 111 }
 112
 113 struct nvmm_type *nvm_init_mgr(struct nvm_dev *dev)
 114 {
 115         struct nvmm_type *mt;
 116         int ret;
 117
 118         lockdep_assert_held(&nvm_lock);
 119
 120         list_for_each_entry(mt, &nvm_mgrs, list) {
 121                 if (strncmp(dev->sb.mmtype, mt->name, NVM_MMTYPE_LEN))
 122                         continue;
 123
 124                 ret = mt->register_mgr(dev);
 125                 if (ret < 0) {
 126                         pr_err("nvm: media mgr failed to init (%d) on dev %s\n",
 127                                                                 ret, dev->name);
 128                         return NULL; /* initialization failed */
 129                 } else if (ret > 0)
 130                         return mt;
 131         }
 132
 133         return NULL;
 134 }
 135
 136 int nvm_register_mgr(struct nvmm_type *mt)
 137 {
 138         struct nvm_dev *dev;
 139         int ret = 0;
 140
 141         down_write(&nvm_lock);
 142         if (nvm_find_mgr_type(mt->name)) {
 143                 ret = -EEXIST;
 144                 goto finish;
 145         } else {
 146                 list_add(&mt->list, &nvm_mgrs);
 147         }
 148
 149         /* try to register media mgr if any device have none configured */
 150         list_for_each_entry(dev, &nvm_devices, devices) {
 151                 if (dev->mt)
 152                         continue;
 153
 154                 dev->mt = nvm_init_mgr(dev);
 155         }
 156 finish:
 157         up_write(&nvm_lock);
 158
 159         return ret;
 160 }
 161 EXPORT_SYMBOL(nvm_register_mgr);
 162
 163 void nvm_unregister_mgr(struct nvmm_type *mt)
 164 {
 165         if (!mt)
 166                 return;
 167
 168         down_write(&nvm_lock);
 169         list_del(&mt->list);
 170         up_write(&nvm_lock);
 171 }
 172 EXPORT_SYMBOL(nvm_unregister_mgr);
 173
 174 static struct nvm_dev *nvm_find_nvm_dev(const char *name)
 175 {
 176         struct nvm_dev *dev;
 177
 178         list_for_each_entry(dev, &nvm_devices, devices)
 179                 if (!strcmp(name, dev->name))
 180                         return dev;
 181
 182         return NULL;
 183 }
 184
 185 struct nvm_block *nvm_get_blk_unlocked(struct nvm_dev *dev, struct nvm_lun *lun,
 186                                                         unsigned long flags)
 187 {
 188         return dev->mt->get_blk_unlocked(dev, lun, flags);
 189 }
 190 EXPORT_SYMBOL(nvm_get_blk_unlocked);
 191
 192 /* Assumes that all valid pages have already been moved on release to bm */
 193 void nvm_put_blk_unlocked(struct nvm_dev *dev, struct nvm_block *blk)
 194 {
 195         return dev->mt->put_blk_unlocked(dev, blk);
 196 }
 197 EXPORT_SYMBOL(nvm_put_blk_unlocked);
 198
 199 struct nvm_block *nvm_get_blk(struct nvm_dev *dev, struct nvm_lun *lun,
 200                                                         unsigned long flags)
 201 {
 202         return dev->mt->get_blk(dev, lun, flags);
 203 }
 204 EXPORT_SYMBOL(nvm_get_blk);
 205
 206 /* Assumes that all valid pages have already been moved on release to bm */
 207 void nvm_put_blk(struct nvm_dev *dev, struct nvm_block *blk)
 208 {
 209         return dev->mt->put_blk(dev, blk);
 210 }
 211 EXPORT_SYMBOL(nvm_put_blk);
 212
 213 int nvm_submit_io(struct nvm_dev *dev, struct nvm_rq *rqd)
 214 {
 215         return dev->mt->submit_io(dev, rqd);
 216 }
 217 EXPORT_SYMBOL(nvm_submit_io);
 218
 219 int nvm_erase_blk(struct nvm_dev *dev, struct nvm_block *blk)
 220 {
 221         return dev->mt->erase_blk(dev, blk, 0);
 222 }
 223 EXPORT_SYMBOL(nvm_erase_blk);
 224
 225 void nvm_addr_to_generic_mode(struct nvm_dev *dev, struct nvm_rq *rqd)
 226 {
 227         int i;
 228
 229         if (rqd->nr_pages > 1) {
 230                 for (i = 0; i < rqd->nr_pages; i++)
 231                         rqd->ppa_list[i] = dev_to_generic_addr(dev,
 232                                                         rqd->ppa_list[i]);
 233         } else {
 234                 rqd->ppa_addr = dev_to_generic_addr(dev, rqd->ppa_addr);
 235         }
 236 }
 237 EXPORT_SYMBOL(nvm_addr_to_generic_mode);
 238
 239 void nvm_generic_to_addr_mode(struct nvm_dev *dev, struct nvm_rq *rqd)
 240 {
 241         int i;
 242
 243         if (rqd->nr_pages > 1) {
 244                 for (i = 0; i < rqd->nr_pages; i++)
 245                         rqd->ppa_list[i] = generic_to_dev_addr(dev,
 246                                                         rqd->ppa_list[i]);
 247         } else {
 248                 rqd->ppa_addr = generic_to_dev_addr(dev, rqd->ppa_addr);
 249         }
 250 }
 251 EXPORT_SYMBOL(nvm_generic_to_addr_mode);
 252
 253 int nvm_set_rqd_ppalist(struct nvm_dev *dev, struct nvm_rq *rqd,
 254                                 struct ppa_addr *ppas, int nr_ppas, int vblk)
 255 {
 256         int i, plane_cnt, pl_idx;
 257
 258         if ((!vblk || dev->plane_mode == NVM_PLANE_SINGLE) && nr_ppas == 1) {
 259                 rqd->nr_pages = nr_ppas;
 260                 rqd->ppa_addr = ppas[0];
 261
 262                 return 0;
 263         }
 264
 265         rqd->nr_pages = nr_ppas;
 266         rqd->ppa_list = nvm_dev_dma_alloc(dev, GFP_KERNEL, &rqd->dma_ppa_list);
 267         if (!rqd->ppa_list) {
 268                 pr_err("nvm: failed to allocate dma memory\n");
 269                 return -ENOMEM;
 270         }
 271
 272         if (!vblk) {
 273                 for (i = 0; i < nr_ppas; i++)
 274                         rqd->ppa_list[i] = ppas[i];
 275         } else {
 276                 plane_cnt = dev->plane_mode;
 277                 rqd->nr_pages *= plane_cnt;
 278
 279                 for (i = 0; i < nr_ppas; i++) {
 280                         for (pl_idx = 0; pl_idx < plane_cnt; pl_idx++) {
 281                                 ppas[i].g.pl = pl_idx;
 282                                 rqd->ppa_list[(pl_idx * nr_ppas) + i] = ppas[i];
 283                         }
 284                 }
 285         }
 286
 287         return 0;
 288 }
 289 EXPORT_SYMBOL(nvm_set_rqd_ppalist);
 290
 291 void nvm_free_rqd_ppalist(struct nvm_dev *dev, struct nvm_rq *rqd)
 292 {
 293         if (!rqd->ppa_list)
 294                 return;
 295
 296         nvm_dev_dma_free(dev, rqd->ppa_list, rqd->dma_ppa_list);
 297 }
 298 EXPORT_SYMBOL(nvm_free_rqd_ppalist);
 299
 300 int nvm_erase_ppa(struct nvm_dev *dev, struct ppa_addr *ppas, int nr_ppas)
 301 {
 302         struct nvm_rq rqd;
 303         int ret;
 304
 305         if (!dev->ops->erase_block)
 306                 return 0;
 307
 308         memset(&rqd, 0, sizeof(struct nvm_rq));
 309
 310         ret = nvm_set_rqd_ppalist(dev, &rqd, ppas, nr_ppas, 1);
 311         if (ret)
 312                 return ret;
 313
 314         nvm_generic_to_addr_mode(dev, &rqd);
 315
 316         ret = dev->ops->erase_block(dev, &rqd);
 317
 318         nvm_free_rqd_ppalist(dev, &rqd);
 319
 320         return ret;
 321 }
 322 EXPORT_SYMBOL(nvm_erase_ppa);
 323
 324 void nvm_end_io(struct nvm_rq *rqd, int error)
 325 {
 326         rqd->error = error;
 327         rqd->end_io(rqd);
 328 }
 329 EXPORT_SYMBOL(nvm_end_io);
 330
 331 static void nvm_end_io_sync(struct nvm_rq *rqd)
 332 {
 333         struct completion *waiting = rqd->wait;
 334
 335         rqd->wait = NULL;
 336
 337         complete(waiting);
 338 }
 339
 340 int __nvm_submit_ppa(struct nvm_dev *dev, struct nvm_rq *rqd, int opcode,
 341                                                 int flags, void *buf, int len)
 342 {
 343         DECLARE_COMPLETION_ONSTACK(wait);
 344         struct bio *bio;
 345         int ret;
 346         unsigned long hang_check;
 347
 348         bio = bio_map_kern(dev->q, buf, len, GFP_KERNEL);
 349         if (IS_ERR_OR_NULL(bio))
 350                 return -ENOMEM;
 351
 352         nvm_generic_to_addr_mode(dev, rqd);
 353
 354         rqd->dev = dev;
 355         rqd->opcode = opcode;
 356         rqd->flags = flags;
 357         rqd->bio = bio;
 358         rqd->wait = &wait;
 359         rqd->end_io = nvm_end_io_sync;
 360
 361         ret = dev->ops->submit_io(dev, rqd);
 362         if (ret) {
 363                 bio_put(bio);
 364                 return ret;
 365         }
 366
 367         /* Prevent hang_check timer from firing at us during very long I/O */
 368         hang_check = sysctl_hung_task_timeout_secs;
 369         if (hang_check)
 370                 while (!wait_for_completion_io_timeout(&wait, hang_check * (HZ/2)));
 371         else
 372                 wait_for_completion_io(&wait);
 373
 374         return rqd->error;
 375 }
 376
 377 /**
 378  * nvm_submit_ppa_list - submit user-defined ppa list to device. The user must
 379  *                       take to free ppa list if necessary.
 380  * @dev:        device
 381  * @ppa_list:   user created ppa_list
 382  * @nr_ppas:    length of ppa_list
 383  * @opcode:     device opcode
 384  * @flags:      device flags
 385  * @buf:        data buffer
 386  * @len:        data buffer length
 387  */
 388 int nvm_submit_ppa_list(struct nvm_dev *dev, struct ppa_addr *ppa_list,
 389                         int nr_ppas, int opcode, int flags, void *buf, int len)
 390 {
 391         struct nvm_rq rqd;
 392
 393         if (dev->ops->max_phys_sect < nr_ppas)
 394                 return -EINVAL;
 395
 396         memset(&rqd, 0, sizeof(struct nvm_rq));
 397
 398         rqd.nr_pages = nr_ppas;
 399         if (nr_ppas > 1)
 400                 rqd.ppa_list = ppa_list;
 401         else
 402                 rqd.ppa_addr = ppa_list[0];
 403
 404         return __nvm_submit_ppa(dev, &rqd, opcode, flags, buf, len);
 405 }
 406 EXPORT_SYMBOL(nvm_submit_ppa_list);
 407
 408 /**
 409  * nvm_submit_ppa - submit PPAs to device. PPAs will automatically be unfolded
 410  *                  as single, dual, quad plane PPAs depending on device type.
 411  * @dev:        device
 412  * @ppa:        user created ppa_list
 413  * @nr_ppas:    length of ppa_list
 414  * @opcode:     device opcode
 415  * @flags:      device flags
 416  * @buf:        data buffer
 417  * @len:        data buffer length
 418  */
 419 int nvm_submit_ppa(struct nvm_dev *dev, struct ppa_addr *ppa, int nr_ppas,
 420                                 int opcode, int flags, void *buf, int len)
 421 {
 422         struct nvm_rq rqd;
 423         int ret;
 424
 425         memset(&rqd, 0, sizeof(struct nvm_rq));
 426         ret = nvm_set_rqd_ppalist(dev, &rqd, ppa, nr_ppas, 1);
 427         if (ret)
 428                 return ret;
 429
 430         ret = __nvm_submit_ppa(dev, &rqd, opcode, flags, buf, len);
 431
 432         nvm_free_rqd_ppalist(dev, &rqd);
 433
 434         return ret;
 435 }
 436 EXPORT_SYMBOL(nvm_submit_ppa);
 437
 438 /*
 439  * folds a bad block list from its plane representation to its virtual
 440  * block representation. The fold is done in place and reduced size is
 441  * returned.
 442  *
 443  * If any of the planes status are bad or grown bad block, the virtual block
 444  * is marked bad. If not bad, the first plane state acts as the block state.
 445  */
 446 int nvm_bb_tbl_fold(struct nvm_dev *dev, u8 *blks, int nr_blks)
 447 {
 448         int blk, offset, pl, blktype;
 449
 450         if (nr_blks != dev->blks_per_lun * dev->plane_mode)
 451                 return -EINVAL;
 452
 453         for (blk = 0; blk < dev->blks_per_lun; blk++) {
 454                 offset = blk * dev->plane_mode;
 455                 blktype = blks[offset];
 456
 457                 /* Bad blocks on any planes take precedence over other types */
 458                 for (pl = 0; pl < dev->plane_mode; pl++) {
 459                         if (blks[offset + pl] &
 460                                         (NVM_BLK_T_BAD|NVM_BLK_T_GRWN_BAD)) {
 461                                 blktype = blks[offset + pl];
 462                                 break;
 463                         }
 464                 }
 465
 466                 blks[blk] = blktype;
 467         }
 468
 469         return dev->blks_per_lun;
 470 }
 471 EXPORT_SYMBOL(nvm_bb_tbl_fold);
 472
 473 int nvm_get_bb_tbl(struct nvm_dev *dev, struct ppa_addr ppa, u8 *blks)
 474 {
 475         ppa = generic_to_dev_addr(dev, ppa);
 476
 477         return dev->ops->get_bb_tbl(dev, ppa, blks);
 478 }
 479 EXPORT_SYMBOL(nvm_get_bb_tbl);
 480
 481 static int nvm_init_slc_tbl(struct nvm_dev *dev, struct nvm_id_group *grp)
 482 {
 483         int i;
 484
 485         dev->lps_per_blk = dev->pgs_per_blk;
 486         dev->lptbl = kcalloc(dev->lps_per_blk, sizeof(int), GFP_KERNEL);
 487         if (!dev->lptbl)
 488                 return -ENOMEM;
 489
 490         /* Just a linear array */
 491         for (i = 0; i < dev->lps_per_blk; i++)
 492                 dev->lptbl[i] = i;
 493
 494         return 0;
 495 }
 496
 497 static int nvm_init_mlc_tbl(struct nvm_dev *dev, struct nvm_id_group *grp)
 498 {
 499         int i, p;
 500         struct nvm_id_lp_mlc *mlc = &grp->lptbl.mlc;
 501
 502         if (!mlc->num_pairs)
 503                 return 0;
 504
 505         dev->lps_per_blk = mlc->num_pairs;
 506         dev->lptbl = kcalloc(dev->lps_per_blk, sizeof(int), GFP_KERNEL);
 507         if (!dev->lptbl)
 508                 return -ENOMEM;
 509
 510         /* The lower page table encoding consists of a list of bytes, where each
 511          * has a lower and an upper half. The first half byte maintains the
 512          * increment value and every value after is an offset added to the
 513          * previous incrementation value */
 514         dev->lptbl[0] = mlc->pairs[0] & 0xF;
 515         for (i = 1; i < dev->lps_per_blk; i++) {
 516                 p = mlc->pairs[i >> 1];
 517                 if (i & 0x1) /* upper */
 518                         dev->lptbl[i] = dev->lptbl[i - 1] + ((p & 0xF0) >> 4);
 519                 else /* lower */
 520                         dev->lptbl[i] = dev->lptbl[i - 1] + (p & 0xF);
 521         }
 522
 523         return 0;
 524 }
 525
 526 static int nvm_core_init(struct nvm_dev *dev)
 527 {
 528         struct nvm_id *id = &dev->identity;
 529         struct nvm_id_group *grp = &id->groups[0];
 530         int ret;
 531
 532         /* device values */
 533         dev->nr_chnls = grp->num_ch;
 534         dev->luns_per_chnl = grp->num_lun;
 535         dev->pgs_per_blk = grp->num_pg;
 536         dev->blks_per_lun = grp->num_blk;
 537         dev->nr_planes = grp->num_pln;
 538         dev->fpg_size = grp->fpg_sz;
 539         dev->pfpg_size = grp->fpg_sz * grp->num_pln;
 540         dev->sec_size = grp->csecs;
 541         dev->oob_size = grp->sos;
 542         dev->sec_per_pg = grp->fpg_sz / grp->csecs;
 543         dev->mccap = grp->mccap;
 544         memcpy(&dev->ppaf, &id->ppaf, sizeof(struct nvm_addr_format));
 545
 546         dev->plane_mode = NVM_PLANE_SINGLE;
 547         dev->max_rq_size = dev->ops->max_phys_sect * dev->sec_size;
 548
 549         if (grp->mpos & 0x020202)
 550                 dev->plane_mode = NVM_PLANE_DOUBLE;
 551         if (grp->mpos & 0x040404)
 552                 dev->plane_mode = NVM_PLANE_QUAD;
 553
 554         if (grp->mtype != 0) {
 555                 pr_err("nvm: memory type not supported\n");
 556                 return -EINVAL;
 557         }
 558
 559         /* calculated values */
 560         dev->sec_per_pl = dev->sec_per_pg * dev->nr_planes;
 561         dev->sec_per_blk = dev->sec_per_pl * dev->pgs_per_blk;
 562         dev->sec_per_lun = dev->sec_per_blk * dev->blks_per_lun;
 563         dev->nr_luns = dev->luns_per_chnl * dev->nr_chnls;
 564
 565         dev->total_secs = dev->nr_luns * dev->sec_per_lun;
 566         dev->lun_map = kcalloc(BITS_TO_LONGS(dev->nr_luns),
 567                                         sizeof(unsigned long), GFP_KERNEL);
 568         if (!dev->lun_map)
 569                 return -ENOMEM;
 570
 571         switch (grp->fmtype) {
 572         case NVM_ID_FMTYPE_SLC:
 573                 if (nvm_init_slc_tbl(dev, grp)) {
 574                         ret = -ENOMEM;
 575                         goto err_fmtype;
 576                 }
 577                 break;
 578         case NVM_ID_FMTYPE_MLC:
 579                 if (nvm_init_mlc_tbl(dev, grp)) {
 580                         ret = -ENOMEM;
 581                         goto err_fmtype;
 582                 }
 583                 break;
 584         default:
 585                 pr_err("nvm: flash type not supported\n");
 586                 ret = -EINVAL;
 587                 goto err_fmtype;
 588         }
 589
 590         mutex_init(&dev->mlock);
 591         spin_lock_init(&dev->lock);
 592
 593         return 0;
 594 err_fmtype:
 595         kfree(dev->lun_map);
 596         return ret;
 597 }
 598
 599 static void nvm_free(struct nvm_dev *dev)
 600 {
 601         if (!dev)
 602                 return;
 603
 604         if (dev->mt)
 605                 dev->mt->unregister_mgr(dev);
 606
 607         kfree(dev->lptbl);
 608         kfree(dev->lun_map);
 609 }
 610
 611 static int nvm_init(struct nvm_dev *dev)
 612 {
 613         int ret = -EINVAL;
 614
 615         if (!dev->q || !dev->ops)
 616                 return ret;
 617
 618         if (dev->ops->identity(dev, &dev->identity)) {
 619                 pr_err("nvm: device could not be identified\n");
 620                 goto err;
 621         }
 622
 623         pr_debug("nvm: ver:%x nvm_vendor:%x groups:%u\n",
 624                         dev->identity.ver_id, dev->identity.vmnt,
 625                                                         dev->identity.cgrps);
 626
 627         if (dev->identity.ver_id != 1) {
 628                 pr_err("nvm: device not supported by kernel.");
 629                 goto err;
 630         }
 631
 632         if (dev->identity.cgrps != 1) {
 633                 pr_err("nvm: only one group configuration supported.");
 634                 goto err;
 635         }
 636
 637         ret = nvm_core_init(dev);
 638         if (ret) {
 639                 pr_err("nvm: could not initialize core structures.\n");
 640                 goto err;
 641         }
 642
 643         pr_info("nvm: registered %s [%u/%u/%u/%u/%u/%u]\n",
 644                         dev->name, dev->sec_per_pg, dev->nr_planes,
 645                         dev->pgs_per_blk, dev->blks_per_lun, dev->nr_luns,
 646                         dev->nr_chnls);
 647         return 0;
 648 err:
 649         pr_err("nvm: failed to initialize nvm\n");
 650         return ret;
 651 }
 652
 653 static void nvm_exit(struct nvm_dev *dev)
 654 {
 655         if (dev->dma_pool)
 656                 dev->ops->destroy_dma_pool(dev->dma_pool);
 657         nvm_free(dev);
 658
 659         pr_info("nvm: successfully unloaded\n");
 660 }
 661
 662 int nvm_register(struct request_queue *q, char *disk_name,
 663                                                         struct nvm_dev_ops *ops)
 664 {
 665         struct nvm_dev *dev;
 666         int ret;
 667
 668         if (!ops->identity)
 669                 return -EINVAL;
 670
 671         dev = kzalloc(sizeof(struct nvm_dev), GFP_KERNEL);
 672         if (!dev)
 673                 return -ENOMEM;
 674
 675         dev->q = q;
 676         dev->ops = ops;
 677         strncpy(dev->name, disk_name, DISK_NAME_LEN);
 678
 679         ret = nvm_init(dev);
 680         if (ret)
 681                 goto err_init;
 682
 683         if (dev->ops->max_phys_sect > 256) {
 684                 pr_info("nvm: max sectors supported is 256.\n");
 685                 ret = -EINVAL;
 686                 goto err_init;
 687         }
 688
 689         if (dev->ops->max_phys_sect > 1) {
 690                 dev->dma_pool = dev->ops->create_dma_pool(dev, "ppalist");
 691                 if (!dev->dma_pool) {
 692                         pr_err("nvm: could not create dma pool\n");
 693                         ret = -ENOMEM;
 694                         goto err_init;
 695                 }
 696         }
 697
 698         if (dev->identity.cap & NVM_ID_DCAP_BBLKMGMT) {
 699                 ret = nvm_get_sysblock(dev, &dev->sb);
 700                 if (!ret)
 701                         pr_err("nvm: device not initialized.\n");
 702                 else if (ret < 0)
 703                         pr_err("nvm: err (%d) on device initialization\n", ret);
 704         }
 705
 706         /* register device with a supported media manager */
 707         down_write(&nvm_lock);
 708         if (ret > 0)
 709                 dev->mt = nvm_init_mgr(dev);
 710         list_add(&dev->devices, &nvm_devices);
 711         up_write(&nvm_lock);
 712
 713         return 0;
 714 err_init:
 715         kfree(dev->lun_map);
 716         kfree(dev);
 717         return ret;
 718 }
 719 EXPORT_SYMBOL(nvm_register);
 720
 721 void nvm_unregister(char *disk_name)
 722 {
 723         struct nvm_dev *dev;
 724
 725         down_write(&nvm_lock);
 726         dev = nvm_find_nvm_dev(disk_name);
 727         if (!dev) {
 728                 pr_err("nvm: could not find device %s to unregister\n",
 729                                                                 disk_name);
 730                 up_write(&nvm_lock);
 731                 return;
 732         }
 733
 734         list_del(&dev->devices);
 735         up_write(&nvm_lock);
 736
 737         nvm_exit(dev);
 738         kfree(dev);
 739 }
 740 EXPORT_SYMBOL(nvm_unregister);
 741
 742 static const struct block_device_operations nvm_fops = {
 743         .owner          = THIS_MODULE,
 744 };
 745
 746 static int nvm_create_target(struct nvm_dev *dev,
 747                                                 struct nvm_ioctl_create *create)
 748 {
 749         struct nvm_ioctl_create_simple *s = &create->conf.s;
 750         struct request_queue *tqueue;
 751         struct gendisk *tdisk;
 752         struct nvm_tgt_type *tt;
 753         struct nvm_target *t;
 754         void *targetdata;
 755
 756         if (!dev->mt) {
 757                 pr_info("nvm: device has no media manager registered.\n");
 758                 return -ENODEV;
 759         }
 760
 761         down_write(&nvm_lock);
 762         tt = nvm_find_target_type(create->tgttype);
 763         if (!tt) {
 764                 pr_err("nvm: target type %s not found\n", create->tgttype);
 765                 up_write(&nvm_lock);
 766                 return -EINVAL;
 767         }
 768
 769         t = nvm_find_target(create->tgtname);
 770         if (t) {
 771                 pr_err("nvm: target name already exists.\n");
 772                 up_write(&nvm_lock);
 773                 return -EINVAL;
 774         }
 775         up_write(&nvm_lock);
 776
 777         t = kmalloc(sizeof(struct nvm_target), GFP_KERNEL);
 778         if (!t)
 779                 return -ENOMEM;
 780
 781         tqueue = blk_alloc_queue_node(GFP_KERNEL, dev->q->node);
 782         if (!tqueue)
 783                 goto err_t;
 784         blk_queue_make_request(tqueue, tt->make_rq);
 785
 786         tdisk = alloc_disk(0);
 787         if (!tdisk)
 788                 goto err_queue;
 789
 790         sprintf(tdisk->disk_name, "%s", create->tgtname);
 791         tdisk->flags = GENHD_FL_EXT_DEVT;
 792         tdisk->major = 0;
 793         tdisk->first_minor = 0;
 794         tdisk->fops = &nvm_fops;
 795         tdisk->queue = tqueue;
 796
 797         targetdata = tt->init(dev, tdisk, s->lun_begin, s->lun_end);
 798         if (IS_ERR(targetdata))
 799                 goto err_init;
 800
 801         tdisk->private_data = targetdata;
 802         tqueue->queuedata = targetdata;
 803
 804         blk_queue_max_hw_sectors(tqueue, 8 * dev->ops->max_phys_sect);
 805
 806         set_capacity(tdisk, tt->capacity(targetdata));
 807         add_disk(tdisk);
 808
 809         t->type = tt;
 810         t->disk = tdisk;
 811
 812         down_write(&nvm_lock);
 813         list_add_tail(&t->list, &nvm_targets);
 814         up_write(&nvm_lock);
 815
 816         return 0;
 817 err_init:
 818         put_disk(tdisk);
 819 err_queue:
 820         blk_cleanup_queue(tqueue);
 821 err_t:
 822         kfree(t);
 823         return -ENOMEM;
 824 }
 825
 826 static void nvm_remove_target(struct nvm_target *t)
 827 {
 828         struct nvm_tgt_type *tt = t->type;
 829         struct gendisk *tdisk = t->disk;
 830         struct request_queue *q = tdisk->queue;
 831
 832         lockdep_assert_held(&nvm_lock);
 833
 834         del_gendisk(tdisk);
 835         blk_cleanup_queue(q);
 836
 837         if (tt->exit)
 838                 tt->exit(tdisk->private_data);
 839
 840         put_disk(tdisk);
 841
 842         list_del(&t->list);
 843         kfree(t);
 844 }
 845
 846 static int __nvm_configure_create(struct nvm_ioctl_create *create)
 847 {
 848         struct nvm_dev *dev;
 849         struct nvm_ioctl_create_simple *s;
 850
 851         down_write(&nvm_lock);
 852         dev = nvm_find_nvm_dev(create->dev);
 853         up_write(&nvm_lock);
 854         if (!dev) {
 855                 pr_err("nvm: device not found\n");
 856                 return -EINVAL;
 857         }
 858
 859         if (create->conf.type != NVM_CONFIG_TYPE_SIMPLE) {
 860                 pr_err("nvm: config type not valid\n");
 861                 return -EINVAL;
 862         }
 863         s = &create->conf.s;
 864
 865         if (s->lun_begin > s->lun_end || s->lun_end > dev->nr_luns) {
 866                 pr_err("nvm: lun out of bound (%u:%u > %u)\n",
 867                         s->lun_begin, s->lun_end, dev->nr_luns);
 868                 return -EINVAL;
 869         }
 870
 871         return nvm_create_target(dev, create);
 872 }
 873
 874 static int __nvm_configure_remove(struct nvm_ioctl_remove *remove)
 875 {
 876         struct nvm_target *t;
 877
 878         down_write(&nvm_lock);
 879         t = nvm_find_target(remove->tgtname);
 880         if (!t) {
 881                 pr_err("nvm: target \"%s\" doesn't exist.\n", remove->tgtname);
 882                 up_write(&nvm_lock);
 883                 return -EINVAL;
 884         }
 885
 886         nvm_remove_target(t);
 887         up_write(&nvm_lock);
 888
 889         return 0;
 890 }
 891
 892 #ifdef CONFIG_NVM_DEBUG
 893 static int nvm_configure_show(const char *val)
 894 {
 895         struct nvm_dev *dev;
 896         char opcode, devname[DISK_NAME_LEN];
 897         int ret;
 898
 899         ret = sscanf(val, "%c %32s", &opcode, devname);
 900         if (ret != 2) {
 901                 pr_err("nvm: invalid command. Use \"opcode devicename\".\n");
 902                 return -EINVAL;
 903         }
 904
 905         down_write(&nvm_lock);
 906         dev = nvm_find_nvm_dev(devname);
 907         up_write(&nvm_lock);
 908         if (!dev) {
 909                 pr_err("nvm: device not found\n");
 910                 return -EINVAL;
 911         }
 912
 913         if (!dev->mt)
 914                 return 0;
 915
 916         dev->mt->lun_info_print(dev);
 917
 918         return 0;
 919 }
 920
 921 static int nvm_configure_remove(const char *val)
 922 {
 923         struct nvm_ioctl_remove remove;
 924         char opcode;
 925         int ret;
 926
 927         ret = sscanf(val, "%c %256s", &opcode, remove.tgtname);
 928         if (ret != 2) {
 929                 pr_err("nvm: invalid command. Use \"d targetname\".\n");
 930                 return -EINVAL;
 931         }
 932
 933         remove.flags = 0;
 934
 935         return __nvm_configure_remove(&remove);
 936 }
 937
 938 static int nvm_configure_create(const char *val)
 939 {
 940         struct nvm_ioctl_create create;
 941         char opcode;
 942         int lun_begin, lun_end, ret;
 943
 944         ret = sscanf(val, "%c %256s %256s %48s %u:%u", &opcode, create.dev,
 945                                                 create.tgtname, create.tgttype,
 946                                                 &lun_begin, &lun_end);
 947         if (ret != 6) {
 948                 pr_err("nvm: invalid command. Use \"opcode device name tgttype lun_begin:lun_end\".\n");
 949                 return -EINVAL;
 950         }
 951
 952         create.flags = 0;
 953         create.conf.type = NVM_CONFIG_TYPE_SIMPLE;
 954         create.conf.s.lun_begin = lun_begin;
 955         create.conf.s.lun_end = lun_end;
 956
 957         return __nvm_configure_create(&create);
 958 }
 959
 960
 961 /* Exposes administrative interface through /sys/module/lnvm/configure_by_str */
 962 static int nvm_configure_by_str_event(const char *val,
 963                                         const struct kernel_param *kp)
 964 {
 965         char opcode;
 966         int ret;
 967
 968         ret = sscanf(val, "%c", &opcode);
 969         if (ret != 1) {
 970                 pr_err("nvm: string must have the format of \"cmd ...\"\n");
 971                 return -EINVAL;
 972         }
 973
 974         switch (opcode) {
 975         case 'a':
 976                 return nvm_configure_create(val);
 977         case 'd':
 978                 return nvm_configure_remove(val);
 979         case 's':
 980                 return nvm_configure_show(val);
 981         default:
 982                 pr_err("nvm: invalid command\n");
 983                 return -EINVAL;
 984         }
 985
 986         return 0;
 987 }
 988
 989 static int nvm_configure_get(char *buf, const struct kernel_param *kp)
 990 {
 991         int sz;
 992         struct nvm_dev *dev;
 993
 994         sz = sprintf(buf, "available devices:\n");
 995         down_write(&nvm_lock);
 996         list_for_each_entry(dev, &nvm_devices, devices) {
 997                 if (sz > 4095 - DISK_NAME_LEN - 2)
 998                         break;
 999                 sz += sprintf(buf + sz, " %32s\n", dev->name);
1000         }
1001         up_write(&nvm_lock);
1002
1003         return sz;
1004 }
1005
1006 static const struct kernel_param_ops nvm_configure_by_str_event_param_ops = {
1007         .set    = nvm_configure_by_str_event,
1008         .get    = nvm_configure_get,
1009 };
1010
1011 #undef MODULE_PARAM_PREFIX
1012 #define MODULE_PARAM_PREFIX     "lnvm."
1013
1014 module_param_cb(configure_debug, &nvm_configure_by_str_event_param_ops, NULL,
1015                                                                         0644);
1016
1017 #endif /* CONFIG_NVM_DEBUG */
1018
1019 static long nvm_ioctl_info(struct file *file, void __user *arg)
1020 {
1021         struct nvm_ioctl_info *info;
1022         struct nvm_tgt_type *tt;
1023         int tgt_iter = 0;
1024
1025         if (!capable(CAP_SYS_ADMIN))
1026                 return -EPERM;
1027
1028         info = memdup_user(arg, sizeof(struct nvm_ioctl_info));
1029         if (IS_ERR(info))
1030                 return -EFAULT;
1031
1032         info->version[0] = NVM_VERSION_MAJOR;
1033         info->version[1] = NVM_VERSION_MINOR;
1034         info->version[2] = NVM_VERSION_PATCH;
1035
1036         down_write(&nvm_lock);
1037         list_for_each_entry(tt, &nvm_tgt_types, list) {
1038                 struct nvm_ioctl_info_tgt *tgt = &info->tgts[tgt_iter];
1039
1040                 tgt->version[0] = tt->version[0];
1041                 tgt->version[1] = tt->version[1];
1042                 tgt->version[2] = tt->version[2];
1043                 strncpy(tgt->tgtname, tt->name, NVM_TTYPE_NAME_MAX);
1044
1045                 tgt_iter++;
1046         }
1047
1048         info->tgtsize = tgt_iter;
1049         up_write(&nvm_lock);
1050
1051         if (copy_to_user(arg, info, sizeof(struct nvm_ioctl_info))) {
1052                 kfree(info);
1053                 return -EFAULT;
1054         }
1055
1056         kfree(info);
1057         return 0;
1058 }
1059
1060 static long nvm_ioctl_get_devices(struct file *file, void __user *arg)
1061 {
1062         struct nvm_ioctl_get_devices *devices;
1063         struct nvm_dev *dev;
1064         int i = 0;
1065
1066         if (!capable(CAP_SYS_ADMIN))
1067                 return -EPERM;
1068
1069         devices = kzalloc(sizeof(struct nvm_ioctl_get_devices), GFP_KERNEL);
1070         if (!devices)
1071                 return -ENOMEM;
1072
1073         down_write(&nvm_lock);
1074         list_for_each_entry(dev, &nvm_devices, devices) {
1075                 struct nvm_ioctl_device_info *info = &devices->info[i];
1076
1077                 sprintf(info->devname, "%s", dev->name);
1078                 if (dev->mt) {
1079                         info->bmversion[0] = dev->mt->version[0];
1080                         info->bmversion[1] = dev->mt->version[1];
1081                         info->bmversion[2] = dev->mt->version[2];
1082                         sprintf(info->bmname, "%s", dev->mt->name);
1083                 } else {
1084                         sprintf(info->bmname, "none");
1085                 }
1086
1087                 i++;
1088                 if (i > 31) {
1089                         pr_err("nvm: max 31 devices can be reported.\n");
1090                         break;
1091                 }
1092         }
1093         up_write(&nvm_lock);
1094
1095         devices->nr_devices = i;
1096
1097         if (copy_to_user(arg, devices,
1098                          sizeof(struct nvm_ioctl_get_devices))) {
1099                 kfree(devices);
1100                 return -EFAULT;
1101         }
1102
1103         kfree(devices);
1104         return 0;
1105 }
1106
1107 static long nvm_ioctl_dev_create(struct file *file, void __user *arg)
1108 {
1109         struct nvm_ioctl_create create;
1110
1111         if (!capable(CAP_SYS_ADMIN))
1112                 return -EPERM;
1113
1114         if (copy_from_user(&create, arg, sizeof(struct nvm_ioctl_create)))
1115                 return -EFAULT;
1116
1117         create.dev[DISK_NAME_LEN - 1] = '\0';
1118         create.tgttype[NVM_TTYPE_NAME_MAX - 1] = '\0';
1119         create.tgtname[DISK_NAME_LEN - 1] = '\0';
1120
1121         if (create.flags != 0) {
1122                 pr_err("nvm: no flags supported\n");
1123                 return -EINVAL;
1124         }
1125
1126         return __nvm_configure_create(&create);
1127 }
1128
1129 static long nvm_ioctl_dev_remove(struct file *file, void __user *arg)
1130 {
1131         struct nvm_ioctl_remove remove;
1132
1133         if (!capable(CAP_SYS_ADMIN))
1134                 return -EPERM;
1135
1136         if (copy_from_user(&remove, arg, sizeof(struct nvm_ioctl_remove)))
1137                 return -EFAULT;
1138
1139         remove.tgtname[DISK_NAME_LEN - 1] = '\0';
1140
1141         if (remove.flags != 0) {
1142                 pr_err("nvm: no flags supported\n");
1143                 return -EINVAL;
1144         }
1145
1146         return __nvm_configure_remove(&remove);
1147 }
1148
1149 static void nvm_setup_nvm_sb_info(struct nvm_sb_info *info)
1150 {
1151         info->seqnr = 1;
1152         info->erase_cnt = 0;
1153         info->version = 1;
1154 }
1155
1156 static long __nvm_ioctl_dev_init(struct nvm_ioctl_dev_init *init)
1157 {
1158         struct nvm_dev *dev;
1159         struct nvm_sb_info info;
1160         int ret;
1161
1162         down_write(&nvm_lock);
1163         dev = nvm_find_nvm_dev(init->dev);
1164         up_write(&nvm_lock);
1165         if (!dev) {
1166                 pr_err("nvm: device not found\n");
1167                 return -EINVAL;
1168         }
1169
1170         nvm_setup_nvm_sb_info(&info);
1171
1172         strncpy(info.mmtype, init->mmtype, NVM_MMTYPE_LEN);
1173         info.fs_ppa.ppa = -1;
1174
1175         if (dev->identity.cap & NVM_ID_DCAP_BBLKMGMT) {
1176                 ret = nvm_init_sysblock(dev, &info);
1177                 if (ret)
1178                         return ret;
1179         }
1180
1181         memcpy(&dev->sb, &info, sizeof(struct nvm_sb_info));
1182
1183         down_write(&nvm_lock);
1184         dev->mt = nvm_init_mgr(dev);
1185         up_write(&nvm_lock);
1186
1187         return 0;
1188 }
1189
1190 static long nvm_ioctl_dev_init(struct file *file, void __user *arg)
1191 {
1192         struct nvm_ioctl_dev_init init;
1193
1194         if (!capable(CAP_SYS_ADMIN))
1195                 return -EPERM;
1196
1197         if (copy_from_user(&init, arg, sizeof(struct nvm_ioctl_dev_init)))
1198                 return -EFAULT;
1199
1200         if (init.flags != 0) {
1201                 pr_err("nvm: no flags supported\n");
1202                 return -EINVAL;
1203         }
1204
1205         init.dev[DISK_NAME_LEN - 1] = '\0';
1206
1207         return __nvm_ioctl_dev_init(&init);
1208 }
1209
1210 static long nvm_ioctl_dev_factory(struct file *file, void __user *arg)
1211 {
1212         struct nvm_ioctl_dev_factory fact;
1213         struct nvm_dev *dev;
1214
1215         if (!capable(CAP_SYS_ADMIN))
1216                 return -EPERM;
1217
1218         if (copy_from_user(&fact, arg, sizeof(struct nvm_ioctl_dev_factory)))
1219                 return -EFAULT;
1220
1221         fact.dev[DISK_NAME_LEN - 1] = '\0';
1222
1223         if (fact.flags & ~(NVM_FACTORY_NR_BITS - 1))
1224                 return -EINVAL;
1225
1226         down_write(&nvm_lock);
1227         dev = nvm_find_nvm_dev(fact.dev);
1228         up_write(&nvm_lock);
1229         if (!dev) {
1230                 pr_err("nvm: device not found\n");
1231                 return -EINVAL;
1232         }
1233
1234         if (dev->mt) {
1235                 dev->mt->unregister_mgr(dev);
1236                 dev->mt = NULL;
1237         }
1238
1239         if (dev->identity.cap & NVM_ID_DCAP_BBLKMGMT)
1240                 return nvm_dev_factory(dev, fact.flags);
1241
1242         return 0;
1243 }
1244
1245 static long nvm_ctl_ioctl(struct file *file, uint cmd, unsigned long arg)
1246 {
1247         void __user *argp = (void __user *)arg;
1248
1249         switch (cmd) {
1250         case NVM_INFO:
1251                 return nvm_ioctl_info(file, argp);
1252         case NVM_GET_DEVICES:
1253                 return nvm_ioctl_get_devices(file, argp);
1254         case NVM_DEV_CREATE:
1255                 return nvm_ioctl_dev_create(file, argp);
1256         case NVM_DEV_REMOVE:
1257                 return nvm_ioctl_dev_remove(file, argp);
1258         case NVM_DEV_INIT:
1259                 return nvm_ioctl_dev_init(file, argp);
1260         case NVM_DEV_FACTORY:
1261                 return nvm_ioctl_dev_factory(file, argp);
1262         }
1263         return 0;
1264 }
1265
1266 static const struct file_operations _ctl_fops = {
1267         .open = nonseekable_open,
1268         .unlocked_ioctl = nvm_ctl_ioctl,
1269         .owner = THIS_MODULE,
1270         .llseek  = noop_llseek,
1271 };
1272
1273 static struct miscdevice _nvm_misc = {
1274         .minor          = MISC_DYNAMIC_MINOR,
1275         .name           = "lightnvm",
1276         .nodename       = "lightnvm/control",
1277         .fops           = &_ctl_fops,
1278 };
1279
1280 MODULE_ALIAS_MISCDEV(MISC_DYNAMIC_MINOR);
1281
1282 static int __init nvm_mod_init(void)
1283 {
1284         int ret;
1285
1286         ret = misc_register(&_nvm_misc);
1287         if (ret)
1288                 pr_err("nvm: misc_register failed for control device");
1289
1290         return ret;
1291 }
1292
1293 static void __exit nvm_mod_exit(void)
1294 {
1295         misc_deregister(&_nvm_misc);
1296 }
1297
1298 MODULE_AUTHOR("Matias Bjorling <m@bjorling.me>");
1299 MODULE_LICENSE("GPL v2");
1300 MODULE_VERSION("0.1");
1301 module_init(nvm_mod_init);
1302 module_exit(nvm_mod_exit);