Linux Audio

Check our new training course

Loading...
Note: File does not exist in v6.8.
   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/list.h>
  22#include <linux/types.h>
  23#include <linux/sem.h>
  24#include <linux/bitmap.h>
  25#include <linux/moduleparam.h>
  26#include <linux/miscdevice.h>
  27#include <linux/lightnvm.h>
  28#include <linux/sched/sysctl.h>
  29
  30static LIST_HEAD(nvm_tgt_types);
  31static DECLARE_RWSEM(nvm_tgtt_lock);
  32static LIST_HEAD(nvm_mgrs);
  33static LIST_HEAD(nvm_devices);
  34static DECLARE_RWSEM(nvm_lock);
  35
  36struct nvm_tgt_type *nvm_find_target_type(const char *name, int lock)
  37{
  38	struct nvm_tgt_type *tmp, *tt = NULL;
  39
  40	if (lock)
  41		down_write(&nvm_tgtt_lock);
  42
  43	list_for_each_entry(tmp, &nvm_tgt_types, list)
  44		if (!strcmp(name, tmp->name)) {
  45			tt = tmp;
  46			break;
  47		}
  48
  49	if (lock)
  50		up_write(&nvm_tgtt_lock);
  51	return tt;
  52}
  53EXPORT_SYMBOL(nvm_find_target_type);
  54
  55int nvm_register_tgt_type(struct nvm_tgt_type *tt)
  56{
  57	int ret = 0;
  58
  59	down_write(&nvm_tgtt_lock);
  60	if (nvm_find_target_type(tt->name, 0))
  61		ret = -EEXIST;
  62	else
  63		list_add(&tt->list, &nvm_tgt_types);
  64	up_write(&nvm_tgtt_lock);
  65
  66	return ret;
  67}
  68EXPORT_SYMBOL(nvm_register_tgt_type);
  69
  70void nvm_unregister_tgt_type(struct nvm_tgt_type *tt)
  71{
  72	if (!tt)
  73		return;
  74
  75	down_write(&nvm_lock);
  76	list_del(&tt->list);
  77	up_write(&nvm_lock);
  78}
  79EXPORT_SYMBOL(nvm_unregister_tgt_type);
  80
  81void *nvm_dev_dma_alloc(struct nvm_dev *dev, gfp_t mem_flags,
  82							dma_addr_t *dma_handler)
  83{
  84	return dev->ops->dev_dma_alloc(dev, dev->dma_pool, mem_flags,
  85								dma_handler);
  86}
  87EXPORT_SYMBOL(nvm_dev_dma_alloc);
  88
  89void nvm_dev_dma_free(struct nvm_dev *dev, void *addr, dma_addr_t dma_handler)
  90{
  91	dev->ops->dev_dma_free(dev->dma_pool, addr, dma_handler);
  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
 106static struct nvmm_type *nvm_init_mgr(struct nvm_dev *dev)
 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) {
 114		if (strncmp(dev->sb.mmtype, mt->name, NVM_MMTYPE_LEN))
 115			continue;
 116
 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
 129int nvm_register_mgr(struct nvmm_type *mt)
 130{
 131	struct nvm_dev *dev;
 132	int ret = 0;
 133
 134	down_write(&nvm_lock);
 135	if (nvm_find_mgr_type(mt->name)) {
 136		ret = -EEXIST;
 137		goto finish;
 138	} else {
 139		list_add(&mt->list, &nvm_mgrs);
 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:
 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
 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
 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
 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
 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
 261int nvm_submit_io(struct nvm_tgt_dev *tgt_dev, struct nvm_rq *rqd)
 262{
 263	struct nvm_dev *dev = tgt_dev->parent;
 264
 265	return dev->mt->submit_io(tgt_dev, rqd);
 266}
 267EXPORT_SYMBOL(nvm_submit_io);
 268
 269int nvm_erase_blk(struct nvm_tgt_dev *tgt_dev, struct ppa_addr *p, int flags)
 270{
 271	struct nvm_dev *dev = tgt_dev->parent;
 272
 273	return dev->mt->erase_blk(tgt_dev, p, flags);
 274}
 275EXPORT_SYMBOL(nvm_erase_blk);
 276
 277int nvm_get_l2p_tbl(struct nvm_tgt_dev *tgt_dev, u64 slba, u32 nlb,
 278		    nvm_l2p_update_fn *update_l2p, void *priv)
 279{
 280	struct nvm_dev *dev = tgt_dev->parent;
 281
 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
 289int nvm_get_area(struct nvm_tgt_dev *tgt_dev, sector_t *lba, sector_t len)
 290{
 291	struct nvm_dev *dev = tgt_dev->parent;
 292
 293	return dev->mt->get_area(dev, lba, len);
 294}
 295EXPORT_SYMBOL(nvm_get_area);
 296
 297void nvm_put_area(struct nvm_tgt_dev *tgt_dev, sector_t lba)
 298{
 299	struct nvm_dev *dev = tgt_dev->parent;
 300
 301	dev->mt->put_area(dev, lba);
 302}
 303EXPORT_SYMBOL(nvm_put_area);
 304
 305void nvm_addr_to_generic_mode(struct nvm_dev *dev, struct nvm_rq *rqd)
 306{
 307	int i;
 308
 309	if (rqd->nr_ppas > 1) {
 310		for (i = 0; i < rqd->nr_ppas; i++)
 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
 323	if (rqd->nr_ppas > 1) {
 324		for (i = 0; i < rqd->nr_ppas; i++)
 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
 333int nvm_set_rqd_ppalist(struct nvm_dev *dev, struct nvm_rq *rqd,
 334			const struct ppa_addr *ppas, int nr_ppas, int vblk)
 335{
 336	struct nvm_geo *geo = &dev->geo;
 337	int i, plane_cnt, pl_idx;
 338	struct ppa_addr ppa;
 339
 340	if ((!vblk || geo->plane_mode == NVM_PLANE_SINGLE) && nr_ppas == 1) {
 341		rqd->nr_ppas = nr_ppas;
 342		rqd->ppa_addr = ppas[0];
 343
 344		return 0;
 345	}
 346
 347	rqd->nr_ppas = nr_ppas;
 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
 354	if (!vblk) {
 355		for (i = 0; i < nr_ppas; i++)
 356			rqd->ppa_list[i] = ppas[i];
 357	} else {
 358		plane_cnt = geo->plane_mode;
 359		rqd->nr_ppas *= plane_cnt;
 360
 361		for (i = 0; i < nr_ppas; i++) {
 362			for (pl_idx = 0; pl_idx < plane_cnt; pl_idx++) {
 363				ppa = ppas[i];
 364				ppa.g.pl = pl_idx;
 365				rqd->ppa_list[(pl_idx * nr_ppas) + i] = ppa;
 366			}
 367		}
 368	}
 369
 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
 383int nvm_erase_ppa(struct nvm_dev *dev, struct ppa_addr *ppas, int nr_ppas,
 384								int flags)
 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
 394	ret = nvm_set_rqd_ppalist(dev, &rqd, ppas, nr_ppas, 1);
 395	if (ret)
 396		return ret;
 397
 398	nvm_generic_to_addr_mode(dev, &rqd);
 399
 400	rqd.flags = flags;
 401
 402	ret = dev->ops->erase_block(dev, &rqd);
 403
 404	nvm_free_rqd_ppalist(dev, &rqd);
 405
 406	return ret;
 407}
 408EXPORT_SYMBOL(nvm_erase_ppa);
 409
 410void nvm_end_io(struct nvm_rq *rqd, int error)
 411{
 412	rqd->error = error;
 413	rqd->end_io(rqd);
 414}
 415EXPORT_SYMBOL(nvm_end_io);
 416
 417static void nvm_end_io_sync(struct nvm_rq *rqd)
 418{
 419	struct completion *waiting = rqd->wait;
 420
 421	rqd->wait = NULL;
 422
 423	complete(waiting);
 424}
 425
 426static int __nvm_submit_ppa(struct nvm_dev *dev, struct nvm_rq *rqd, int opcode,
 427						int flags, void *buf, int len)
 428{
 429	DECLARE_COMPLETION_ONSTACK(wait);
 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
 438	nvm_generic_to_addr_mode(dev, rqd);
 439
 440	rqd->dev = NULL;
 441	rqd->opcode = opcode;
 442	rqd->flags = flags;
 443	rqd->bio = bio;
 444	rqd->wait = &wait;
 445	rqd->end_io = nvm_end_io_sync;
 446
 447	ret = dev->ops->submit_io(dev, rqd);
 448	if (ret) {
 449		bio_put(bio);
 450		return ret;
 451	}
 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)
 456		while (!wait_for_completion_io_timeout(&wait,
 457							hang_check * (HZ/2)))
 458			;
 459	else
 460		wait_for_completion_io(&wait);
 461
 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
 486	rqd.nr_ppas = nr_ppas;
 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));
 514	ret = nvm_set_rqd_ppalist(dev, &rqd, ppa, nr_ppas, 1);
 515	if (ret)
 516		return ret;
 517
 518	ret = __nvm_submit_ppa(dev, &rqd, opcode, flags, buf, len);
 519
 520	nvm_free_rqd_ppalist(dev, &rqd);
 521
 522	return ret;
 523}
 524EXPORT_SYMBOL(nvm_submit_ppa);
 525
 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{
 536	struct nvm_geo *geo = &dev->geo;
 537	int blk, offset, pl, blktype;
 538
 539	if (nr_blks != geo->blks_per_lun * geo->plane_mode)
 540		return -EINVAL;
 541
 542	for (blk = 0; blk < geo->blks_per_lun; blk++) {
 543		offset = blk * geo->plane_mode;
 544		blktype = blks[offset];
 545
 546		/* Bad blocks on any planes take precedence over other types */
 547		for (pl = 0; pl < geo->plane_mode; pl++) {
 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
 558	return geo->blks_per_lun;
 559}
 560EXPORT_SYMBOL(nvm_bb_tbl_fold);
 561
 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
 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
 580static int nvm_init_slc_tbl(struct nvm_dev *dev, struct nvm_id_group *grp)
 581{
 582	struct nvm_geo *geo = &dev->geo;
 583	int i;
 584
 585	dev->lps_per_blk = geo->pgs_per_blk;
 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
 613	 * previous incrementation value
 614	 */
 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
 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];
 631	struct nvm_geo *geo = &dev->geo;
 632	int ret;
 633
 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;
 652
 653	if (grp->mpos & 0x020202)
 654		geo->plane_mode = NVM_PLANE_DOUBLE;
 655	if (grp->mpos & 0x040404)
 656		geo->plane_mode = NVM_PLANE_QUAD;
 657
 658	if (grp->mtype != 0) {
 659		pr_err("nvm: memory type not supported\n");
 660		return -EINVAL;
 661	}
 662
 663	/* calculated values */
 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;
 668
 669	dev->total_secs = geo->nr_luns * geo->sec_per_lun;
 670	dev->lun_map = kcalloc(BITS_TO_LONGS(geo->nr_luns),
 671					sizeof(unsigned long), GFP_KERNEL);
 672	if (!dev->lun_map)
 673		return -ENOMEM;
 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
 694	mutex_init(&dev->mlock);
 695	spin_lock_init(&dev->lock);
 696
 697	blk_queue_logical_block_size(dev->q, geo->sec_size);
 698
 699	return 0;
 700err_fmtype:
 701	kfree(dev->lun_map);
 702	return ret;
 703}
 704
 705static void nvm_free_mgr(struct nvm_dev *dev)
 706{
 707	if (!dev->mt)
 708		return;
 709
 710	dev->mt->unregister_mgr(dev);
 711	dev->mt = NULL;
 712}
 713
 714void nvm_free(struct nvm_dev *dev)
 715{
 716	if (!dev)
 717		return;
 718
 719	nvm_free_mgr(dev);
 720
 721	if (dev->dma_pool)
 722		dev->ops->destroy_dma_pool(dev->dma_pool);
 723
 724	kfree(dev->lptbl);
 725	kfree(dev->lun_map);
 726	kfree(dev);
 727}
 728
 729static int nvm_init(struct nvm_dev *dev)
 730{
 731	struct nvm_geo *geo = &dev->geo;
 732	int ret = -EINVAL;
 733
 734	if (!dev->q || !dev->ops)
 735		return ret;
 736
 737	if (dev->ops->identity(dev, &dev->identity)) {
 738		pr_err("nvm: device could not be identified\n");
 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
 762	pr_info("nvm: registered %s [%u/%u/%u/%u/%u/%u]\n",
 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);
 766	return 0;
 767err:
 768	pr_err("nvm: failed to initialize nvm\n");
 769	return ret;
 770}
 771
 772struct nvm_dev *nvm_alloc_dev(int node)
 773{
 774	return kzalloc_node(sizeof(struct nvm_dev), GFP_KERNEL, node);
 775}
 776EXPORT_SYMBOL(nvm_alloc_dev);
 777
 778int nvm_register(struct nvm_dev *dev)
 779{
 780	int ret;
 781
 782	ret = nvm_init(dev);
 783	if (ret)
 784		goto err_init;
 785
 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
 792	if (dev->ops->max_phys_sect > 1) {
 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");
 796			ret = -ENOMEM;
 797			goto err_init;
 798		}
 799	}
 800
 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	}
 808
 809	/* register device with a supported media manager */
 810	down_write(&nvm_lock);
 811	if (ret > 0)
 812		dev->mt = nvm_init_mgr(dev);
 813	list_add(&dev->devices, &nvm_devices);
 814	up_write(&nvm_lock);
 815
 816	return 0;
 817err_init:
 818	kfree(dev->lun_map);
 819	return ret;
 820}
 821EXPORT_SYMBOL(nvm_register);
 822
 823void nvm_unregister(struct nvm_dev *dev)
 824{
 825	down_write(&nvm_lock);
 826	list_del(&dev->devices);
 827	up_write(&nvm_lock);
 828
 829	nvm_free(dev);
 830}
 831EXPORT_SYMBOL(nvm_unregister);
 832
 833static int __nvm_configure_create(struct nvm_ioctl_create *create)
 834{
 835	struct nvm_dev *dev;
 836	struct nvm_ioctl_create_simple *s;
 837
 838	down_write(&nvm_lock);
 839	dev = nvm_find_nvm_dev(create->dev);
 840	up_write(&nvm_lock);
 841
 842	if (!dev) {
 843		pr_err("nvm: device not found\n");
 844		return -EINVAL;
 845	}
 846
 847	if (!dev->mt) {
 848		pr_info("nvm: device has no media manager registered.\n");
 849		return -ENODEV;
 850	}
 851
 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
 858	if (s->lun_begin > s->lun_end || s->lun_end > dev->geo.nr_luns) {
 859		pr_err("nvm: lun out of bound (%u:%u > %u)\n",
 860			s->lun_begin, s->lun_end, dev->geo.nr_luns);
 861		return -EINVAL;
 862	}
 863
 864	return dev->mt->create_tgt(dev, create);
 865}
 866
 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);
 885	list_for_each_entry(tt, &nvm_tgt_types, list) {
 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
 899	if (copy_to_user(arg, info, sizeof(struct nvm_ioctl_info))) {
 900		kfree(info);
 901		return -EFAULT;
 902	}
 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
 945	if (copy_to_user(arg, devices,
 946			 sizeof(struct nvm_ioctl_get_devices))) {
 947		kfree(devices);
 948		return -EFAULT;
 949	}
 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;
 980	struct nvm_dev *dev;
 981	int ret = 0;
 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
 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;
1003}
1004
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;
1016	int ret;
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
1031	if (dev->identity.cap & NVM_ID_DCAP_BBLKMGMT) {
1032		ret = nvm_init_sysblock(dev, &info);
1033		if (ret)
1034			return ret;
1035	}
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;
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
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
1090	nvm_free_mgr(dev);
1091
1092	if (dev->identity.cap & NVM_ID_DCAP_BBLKMGMT)
1093		return nvm_dev_factory(dev, fact.flags);
1094
1095	return 0;
1096}
1097
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);
1111	case NVM_DEV_INIT:
1112		return nvm_ioctl_dev_init(file, argp);
1113	case NVM_DEV_FACTORY:
1114		return nvm_ioctl_dev_factory(file, argp);
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};
1132builtin_misc_device(_nvm_misc);