mtdchar.c 22.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 * Character-device access to raw MTD devices.
 *
 */

6 7
#include <linux/device.h>
#include <linux/fs.h>
A
Andrew Morton 已提交
8
#include <linux/mm.h>
9
#include <linux/err.h>
10
#include <linux/init.h>
L
Linus Torvalds 已提交
11 12
#include <linux/kernel.h>
#include <linux/module.h>
13 14
#include <linux/slab.h>
#include <linux/sched.h>
15
#include <linux/smp_lock.h>
16
#include <linux/backing-dev.h>
K
Kevin Cernekee 已提交
17
#include <linux/compat.h>
18
#include <linux/mount.h>
19

L
Linus Torvalds 已提交
20 21 22
#include <linux/mtd/mtd.h>
#include <linux/mtd/compatmac.h>

23
#include <asm/uaccess.h>
24

25 26
#define MTD_INODE_FS_MAGIC 0x11307854
static struct vfsmount *mtd_inode_mnt __read_mostly;
L
Linus Torvalds 已提交
27

28
/*
29 30
 * Data structure to hold the pointer to the mtd device as well
 * as mode information ofr various use cases.
31
 */
32 33
struct mtd_file_info {
	struct mtd_info *mtd;
34
	struct inode *ino;
35 36
	enum mtd_file_modes mode;
};
37

L
Linus Torvalds 已提交
38 39
static loff_t mtd_lseek (struct file *file, loff_t offset, int orig)
{
40 41
	struct mtd_file_info *mfi = file->private_data;
	struct mtd_info *mtd = mfi->mtd;
L
Linus Torvalds 已提交
42 43

	switch (orig) {
44
	case SEEK_SET:
L
Linus Torvalds 已提交
45
		break;
46
	case SEEK_CUR:
47
		offset += file->f_pos;
L
Linus Torvalds 已提交
48
		break;
49
	case SEEK_END:
50
		offset += mtd->size;
L
Linus Torvalds 已提交
51 52 53 54 55
		break;
	default:
		return -EINVAL;
	}

56
	if (offset >= 0 && offset <= mtd->size)
57
		return file->f_pos = offset;
L
Linus Torvalds 已提交
58

59
	return -EINVAL;
L
Linus Torvalds 已提交
60 61 62 63 64 65 66 67
}



static int mtd_open(struct inode *inode, struct file *file)
{
	int minor = iminor(inode);
	int devnum = minor >> 1;
68
	int ret = 0;
L
Linus Torvalds 已提交
69
	struct mtd_info *mtd;
70
	struct mtd_file_info *mfi;
71
	struct inode *mtd_ino;
L
Linus Torvalds 已提交
72 73 74 75

	DEBUG(MTD_DEBUG_LEVEL0, "MTD_open\n");

	/* You can't open the RO devices RW */
76
	if ((file->f_mode & FMODE_WRITE) && (minor & 1))
L
Linus Torvalds 已提交
77 78
		return -EACCES;

79
	lock_kernel();
L
Linus Torvalds 已提交
80
	mtd = get_mtd_device(NULL, devnum);
81

82 83 84 85
	if (IS_ERR(mtd)) {
		ret = PTR_ERR(mtd);
		goto out;
	}
86

87
	if (mtd->type == MTD_ABSENT) {
L
Linus Torvalds 已提交
88
		put_mtd_device(mtd);
89 90
		ret = -ENODEV;
		goto out;
L
Linus Torvalds 已提交
91 92
	}

93 94 95 96 97 98 99 100 101 102 103 104 105
	mtd_ino = iget_locked(mtd_inode_mnt->mnt_sb, devnum);
	if (!mtd_ino) {
		put_mtd_device(mtd);
		ret = -ENOMEM;
		goto out;
	}
	if (mtd_ino->i_state & I_NEW) {
		mtd_ino->i_private = mtd;
		mtd_ino->i_mode = S_IFCHR;
		mtd_ino->i_data.backing_dev_info = mtd->backing_dev_info;
		unlock_new_inode(mtd_ino);
	}
	file->f_mapping = mtd_ino->i_mapping;
106

L
Linus Torvalds 已提交
107
	/* You can't open it RW if it's not a writeable device */
108
	if ((file->f_mode & FMODE_WRITE) && !(mtd->flags & MTD_WRITEABLE)) {
109
		iput(mtd_ino);
L
Linus Torvalds 已提交
110
		put_mtd_device(mtd);
111 112
		ret = -EACCES;
		goto out;
L
Linus Torvalds 已提交
113
	}
114

115 116
	mfi = kzalloc(sizeof(*mfi), GFP_KERNEL);
	if (!mfi) {
117
		iput(mtd_ino);
118
		put_mtd_device(mtd);
119 120
		ret = -ENOMEM;
		goto out;
121
	}
122
	mfi->ino = mtd_ino;
123 124 125
	mfi->mtd = mtd;
	file->private_data = mfi;

126 127 128
out:
	unlock_kernel();
	return ret;
L
Linus Torvalds 已提交
129 130 131 132 133 134
} /* mtd_open */

/*====================================================================*/

static int mtd_close(struct inode *inode, struct file *file)
{
135 136
	struct mtd_file_info *mfi = file->private_data;
	struct mtd_info *mtd = mfi->mtd;
L
Linus Torvalds 已提交
137 138 139

	DEBUG(MTD_DEBUG_LEVEL0, "MTD_close\n");

140
	/* Only sync if opened RW */
141
	if ((file->f_mode & FMODE_WRITE) && mtd->sync)
L
Linus Torvalds 已提交
142
		mtd->sync(mtd);
143

144 145
	iput(mfi->ino);

L
Linus Torvalds 已提交
146
	put_mtd_device(mtd);
147 148
	file->private_data = NULL;
	kfree(mfi);
L
Linus Torvalds 已提交
149 150 151 152 153 154 155 156 157 158 159

	return 0;
} /* mtd_close */

/* FIXME: This _really_ needs to die. In 2.5, we should lock the
   userspace buffer down and use it directly with readv/writev.
*/
#define MAX_KMALLOC_SIZE 0x20000

static ssize_t mtd_read(struct file *file, char __user *buf, size_t count,loff_t *ppos)
{
160 161
	struct mtd_file_info *mfi = file->private_data;
	struct mtd_info *mtd = mfi->mtd;
L
Linus Torvalds 已提交
162 163 164 165 166
	size_t retlen=0;
	size_t total_retlen=0;
	int ret=0;
	int len;
	char *kbuf;
167

L
Linus Torvalds 已提交
168 169 170 171 172 173 174
	DEBUG(MTD_DEBUG_LEVEL0,"MTD_read\n");

	if (*ppos + count > mtd->size)
		count = mtd->size - *ppos;

	if (!count)
		return 0;
175

L
Linus Torvalds 已提交
176 177
	/* FIXME: Use kiovec in 2.5 to lock down the user's buffers
	   and pass them directly to the MTD functions */
178 179 180 181 182 183 184 185 186

	if (count > MAX_KMALLOC_SIZE)
		kbuf=kmalloc(MAX_KMALLOC_SIZE, GFP_KERNEL);
	else
		kbuf=kmalloc(count, GFP_KERNEL);

	if (!kbuf)
		return -ENOMEM;

L
Linus Torvalds 已提交
187
	while (count) {
188

189
		if (count > MAX_KMALLOC_SIZE)
L
Linus Torvalds 已提交
190 191 192 193
			len = MAX_KMALLOC_SIZE;
		else
			len = count;

194 195
		switch (mfi->mode) {
		case MTD_MODE_OTP_FACTORY:
196 197 198 199 200
			ret = mtd->read_fact_prot_reg(mtd, *ppos, len, &retlen, kbuf);
			break;
		case MTD_MODE_OTP_USER:
			ret = mtd->read_user_prot_reg(mtd, *ppos, len, &retlen, kbuf);
			break;
201 202 203 204 205 206 207 208 209 210 211 212 213
		case MTD_MODE_RAW:
		{
			struct mtd_oob_ops ops;

			ops.mode = MTD_OOB_RAW;
			ops.datbuf = kbuf;
			ops.oobbuf = NULL;
			ops.len = len;

			ret = mtd->read_oob(mtd, *ppos, &ops);
			retlen = ops.retlen;
			break;
		}
214
		default:
215
			ret = mtd->read(mtd, *ppos, len, &retlen, kbuf);
216
		}
L
Linus Torvalds 已提交
217 218
		/* Nand returns -EBADMSG on ecc errors, but it returns
		 * the data. For our userspace tools it is important
219
		 * to dump areas with ecc errors !
220 221 222
		 * For kernel internal usage it also might return -EUCLEAN
		 * to signal the caller that a bitflip has occured and has
		 * been corrected by the ECC algorithm.
L
Linus Torvalds 已提交
223 224 225
		 * Userspace software which accesses NAND this way
		 * must be aware of the fact that it deals with NAND
		 */
226
		if (!ret || (ret == -EUCLEAN) || (ret == -EBADMSG)) {
L
Linus Torvalds 已提交
227 228
			*ppos += retlen;
			if (copy_to_user(buf, kbuf, retlen)) {
229
				kfree(kbuf);
L
Linus Torvalds 已提交
230 231 232 233 234 235 236
				return -EFAULT;
			}
			else
				total_retlen += retlen;

			count -= retlen;
			buf += retlen;
237 238
			if (retlen == 0)
				count = 0;
L
Linus Torvalds 已提交
239 240 241 242 243
		}
		else {
			kfree(kbuf);
			return ret;
		}
244

L
Linus Torvalds 已提交
245 246
	}

247
	kfree(kbuf);
L
Linus Torvalds 已提交
248 249 250 251 252
	return total_retlen;
} /* mtd_read */

static ssize_t mtd_write(struct file *file, const char __user *buf, size_t count,loff_t *ppos)
{
253 254
	struct mtd_file_info *mfi = file->private_data;
	struct mtd_info *mtd = mfi->mtd;
L
Linus Torvalds 已提交
255 256 257 258 259 260 261
	char *kbuf;
	size_t retlen;
	size_t total_retlen=0;
	int ret=0;
	int len;

	DEBUG(MTD_DEBUG_LEVEL0,"MTD_write\n");
262

L
Linus Torvalds 已提交
263 264
	if (*ppos == mtd->size)
		return -ENOSPC;
265

L
Linus Torvalds 已提交
266 267 268 269 270 271
	if (*ppos + count > mtd->size)
		count = mtd->size - *ppos;

	if (!count)
		return 0;

272 273 274 275 276 277 278 279
	if (count > MAX_KMALLOC_SIZE)
		kbuf=kmalloc(MAX_KMALLOC_SIZE, GFP_KERNEL);
	else
		kbuf=kmalloc(count, GFP_KERNEL);

	if (!kbuf)
		return -ENOMEM;

L
Linus Torvalds 已提交
280
	while (count) {
281

282
		if (count > MAX_KMALLOC_SIZE)
L
Linus Torvalds 已提交
283 284 285 286 287 288 289 290
			len = MAX_KMALLOC_SIZE;
		else
			len = count;

		if (copy_from_user(kbuf, buf, len)) {
			kfree(kbuf);
			return -EFAULT;
		}
291

292 293
		switch (mfi->mode) {
		case MTD_MODE_OTP_FACTORY:
294 295 296 297 298 299 300 301 302
			ret = -EROFS;
			break;
		case MTD_MODE_OTP_USER:
			if (!mtd->write_user_prot_reg) {
				ret = -EOPNOTSUPP;
				break;
			}
			ret = mtd->write_user_prot_reg(mtd, *ppos, len, &retlen, kbuf);
			break;
303 304 305 306 307 308 309 310 311 312 313 314 315 316 317

		case MTD_MODE_RAW:
		{
			struct mtd_oob_ops ops;

			ops.mode = MTD_OOB_RAW;
			ops.datbuf = kbuf;
			ops.oobbuf = NULL;
			ops.len = len;

			ret = mtd->write_oob(mtd, *ppos, &ops);
			retlen = ops.retlen;
			break;
		}

318 319 320
		default:
			ret = (*(mtd->write))(mtd, *ppos, len, &retlen, kbuf);
		}
L
Linus Torvalds 已提交
321 322 323 324 325 326 327 328 329 330 331 332
		if (!ret) {
			*ppos += retlen;
			total_retlen += retlen;
			count -= retlen;
			buf += retlen;
		}
		else {
			kfree(kbuf);
			return ret;
		}
	}

333
	kfree(kbuf);
L
Linus Torvalds 已提交
334 335 336 337 338 339 340 341 342 343 344 345 346
	return total_retlen;
} /* mtd_write */

/*======================================================================

    IOCTL calls for getting device parameters.

======================================================================*/
static void mtdchar_erase_callback (struct erase_info *instr)
{
	wake_up((wait_queue_head_t *)instr->priv);
}

D
David Brownell 已提交
347
#ifdef CONFIG_HAVE_MTD_OTP
348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376
static int otp_select_filemode(struct mtd_file_info *mfi, int mode)
{
	struct mtd_info *mtd = mfi->mtd;
	int ret = 0;

	switch (mode) {
	case MTD_OTP_FACTORY:
		if (!mtd->read_fact_prot_reg)
			ret = -EOPNOTSUPP;
		else
			mfi->mode = MTD_MODE_OTP_FACTORY;
		break;
	case MTD_OTP_USER:
		if (!mtd->read_fact_prot_reg)
			ret = -EOPNOTSUPP;
		else
			mfi->mode = MTD_MODE_OTP_USER;
		break;
	default:
		ret = -EINVAL;
	case MTD_OTP_OFF:
		break;
	}
	return ret;
}
#else
# define otp_select_filemode(f,m)	-EOPNOTSUPP
#endif

K
Kevin Cernekee 已提交
377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393
static int mtd_do_writeoob(struct file *file, struct mtd_info *mtd,
	uint64_t start, uint32_t length, void __user *ptr,
	uint32_t __user *retp)
{
	struct mtd_oob_ops ops;
	uint32_t retlen;
	int ret = 0;

	if (!(file->f_mode & FMODE_WRITE))
		return -EPERM;

	if (length > 4096)
		return -EINVAL;

	if (!mtd->write_oob)
		ret = -EOPNOTSUPP;
	else
394
		ret = access_ok(VERIFY_READ, ptr, length) ? 0 : -EFAULT;
K
Kevin Cernekee 已提交
395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470

	if (ret)
		return ret;

	ops.ooblen = length;
	ops.ooboffs = start & (mtd->oobsize - 1);
	ops.datbuf = NULL;
	ops.mode = MTD_OOB_PLACE;

	if (ops.ooboffs && ops.ooblen > (mtd->oobsize - ops.ooboffs))
		return -EINVAL;

	ops.oobbuf = kmalloc(length, GFP_KERNEL);
	if (!ops.oobbuf)
		return -ENOMEM;

	if (copy_from_user(ops.oobbuf, ptr, length)) {
		kfree(ops.oobbuf);
		return -EFAULT;
	}

	start &= ~((uint64_t)mtd->oobsize - 1);
	ret = mtd->write_oob(mtd, start, &ops);

	if (ops.oobretlen > 0xFFFFFFFFU)
		ret = -EOVERFLOW;
	retlen = ops.oobretlen;
	if (copy_to_user(retp, &retlen, sizeof(length)))
		ret = -EFAULT;

	kfree(ops.oobbuf);
	return ret;
}

static int mtd_do_readoob(struct mtd_info *mtd, uint64_t start,
	uint32_t length, void __user *ptr, uint32_t __user *retp)
{
	struct mtd_oob_ops ops;
	int ret = 0;

	if (length > 4096)
		return -EINVAL;

	if (!mtd->read_oob)
		ret = -EOPNOTSUPP;
	else
		ret = access_ok(VERIFY_WRITE, ptr,
				length) ? 0 : -EFAULT;
	if (ret)
		return ret;

	ops.ooblen = length;
	ops.ooboffs = start & (mtd->oobsize - 1);
	ops.datbuf = NULL;
	ops.mode = MTD_OOB_PLACE;

	if (ops.ooboffs && ops.ooblen > (mtd->oobsize - ops.ooboffs))
		return -EINVAL;

	ops.oobbuf = kmalloc(length, GFP_KERNEL);
	if (!ops.oobbuf)
		return -ENOMEM;

	start &= ~((uint64_t)mtd->oobsize - 1);
	ret = mtd->read_oob(mtd, start, &ops);

	if (put_user(ops.oobretlen, retp))
		ret = -EFAULT;
	else if (ops.oobretlen && copy_to_user(ptr, ops.oobbuf,
					    ops.oobretlen))
		ret = -EFAULT;

	kfree(ops.oobbuf);
	return ret;
}

L
Linus Torvalds 已提交
471 472 473
static int mtd_ioctl(struct inode *inode, struct file *file,
		     u_int cmd, u_long arg)
{
474 475
	struct mtd_file_info *mfi = file->private_data;
	struct mtd_info *mtd = mfi->mtd;
L
Linus Torvalds 已提交
476 477 478
	void __user *argp = (void __user *)arg;
	int ret = 0;
	u_long size;
479
	struct mtd_info_user info;
480

L
Linus Torvalds 已提交
481 482 483 484 485 486 487 488 489 490 491
	DEBUG(MTD_DEBUG_LEVEL0, "MTD_ioctl\n");

	size = (cmd & IOCSIZE_MASK) >> IOCSIZE_SHIFT;
	if (cmd & IOC_IN) {
		if (!access_ok(VERIFY_READ, argp, size))
			return -EFAULT;
	}
	if (cmd & IOC_OUT) {
		if (!access_ok(VERIFY_WRITE, argp, size))
			return -EFAULT;
	}
492

L
Linus Torvalds 已提交
493 494 495 496 497 498 499 500
	switch (cmd) {
	case MEMGETREGIONCOUNT:
		if (copy_to_user(argp, &(mtd->numeraseregions), sizeof(int)))
			return -EFAULT;
		break;

	case MEMGETREGIONINFO:
	{
501 502
		uint32_t ur_idx;
		struct mtd_erase_region_info *kr;
503
		struct region_info_user __user *ur = argp;
L
Linus Torvalds 已提交
504

505
		if (get_user(ur_idx, &(ur->regionindex)))
L
Linus Torvalds 已提交
506 507
			return -EFAULT;

508 509 510 511 512
		kr = &(mtd->eraseregions[ur_idx]);

		if (put_user(kr->offset, &(ur->offset))
		    || put_user(kr->erasesize, &(ur->erasesize))
		    || put_user(kr->numblocks, &(ur->numblocks)))
L
Linus Torvalds 已提交
513
			return -EFAULT;
514

L
Linus Torvalds 已提交
515 516 517 518
		break;
	}

	case MEMGETINFO:
519 520 521 522 523 524
		info.type	= mtd->type;
		info.flags	= mtd->flags;
		info.size	= mtd->size;
		info.erasesize	= mtd->erasesize;
		info.writesize	= mtd->writesize;
		info.oobsize	= mtd->oobsize;
525 526 527
		/* The below fields are obsolete */
		info.ecctype	= -1;
		info.eccsize	= 0;
528
		if (copy_to_user(argp, &info, sizeof(struct mtd_info_user)))
L
Linus Torvalds 已提交
529 530 531 532
			return -EFAULT;
		break;

	case MEMERASE:
533
	case MEMERASE64:
L
Linus Torvalds 已提交
534 535 536
	{
		struct erase_info *erase;

537
		if(!(file->f_mode & FMODE_WRITE))
L
Linus Torvalds 已提交
538 539
			return -EPERM;

540
		erase=kzalloc(sizeof(struct erase_info),GFP_KERNEL);
L
Linus Torvalds 已提交
541 542 543 544 545 546 547 548
		if (!erase)
			ret = -ENOMEM;
		else {
			wait_queue_head_t waitq;
			DECLARE_WAITQUEUE(wait, current);

			init_waitqueue_head(&waitq);

549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568
			if (cmd == MEMERASE64) {
				struct erase_info_user64 einfo64;

				if (copy_from_user(&einfo64, argp,
					    sizeof(struct erase_info_user64))) {
					kfree(erase);
					return -EFAULT;
				}
				erase->addr = einfo64.start;
				erase->len = einfo64.length;
			} else {
				struct erase_info_user einfo32;

				if (copy_from_user(&einfo32, argp,
					    sizeof(struct erase_info_user))) {
					kfree(erase);
					return -EFAULT;
				}
				erase->addr = einfo32.start;
				erase->len = einfo32.length;
L
Linus Torvalds 已提交
569 570 571 572
			}
			erase->mtd = mtd;
			erase->callback = mtdchar_erase_callback;
			erase->priv = (unsigned long)&waitq;
573

L
Linus Torvalds 已提交
574 575 576
			/*
			  FIXME: Allow INTERRUPTIBLE. Which means
			  not having the wait_queue head on the stack.
577

L
Linus Torvalds 已提交
578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602
			  If the wq_head is on the stack, and we
			  leave because we got interrupted, then the
			  wq_head is no longer there when the
			  callback routine tries to wake us up.
			*/
			ret = mtd->erase(mtd, erase);
			if (!ret) {
				set_current_state(TASK_UNINTERRUPTIBLE);
				add_wait_queue(&waitq, &wait);
				if (erase->state != MTD_ERASE_DONE &&
				    erase->state != MTD_ERASE_FAILED)
					schedule();
				remove_wait_queue(&waitq, &wait);
				set_current_state(TASK_RUNNING);

				ret = (erase->state == MTD_ERASE_FAILED)?-EIO:0;
			}
			kfree(erase);
		}
		break;
	}

	case MEMWRITEOOB:
	{
		struct mtd_oob_buf buf;
K
Kevin Cernekee 已提交
603
		struct mtd_oob_buf __user *buf_user = argp;
L
Linus Torvalds 已提交
604

K
Kevin Cernekee 已提交
605 606
		/* NOTE: writes return length to buf_user->length */
		if (copy_from_user(&buf, argp, sizeof(buf)))
L
Linus Torvalds 已提交
607
			ret = -EFAULT;
K
Kevin Cernekee 已提交
608 609 610
		else
			ret = mtd_do_writeoob(file, mtd, buf.start, buf.length,
				buf.ptr, &buf_user->length);
L
Linus Torvalds 已提交
611 612 613 614 615 616
		break;
	}

	case MEMREADOOB:
	{
		struct mtd_oob_buf buf;
K
Kevin Cernekee 已提交
617
		struct mtd_oob_buf __user *buf_user = argp;
618

K
Kevin Cernekee 已提交
619 620
		/* NOTE: writes return length to buf_user->start */
		if (copy_from_user(&buf, argp, sizeof(buf)))
L
Linus Torvalds 已提交
621
			ret = -EFAULT;
K
Kevin Cernekee 已提交
622 623 624
		else
			ret = mtd_do_readoob(mtd, buf.start, buf.length,
				buf.ptr, &buf_user->start);
L
Linus Torvalds 已提交
625 626 627
		break;
	}

628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655
	case MEMWRITEOOB64:
	{
		struct mtd_oob_buf64 buf;
		struct mtd_oob_buf64 __user *buf_user = argp;

		if (copy_from_user(&buf, argp, sizeof(buf)))
			ret = -EFAULT;
		else
			ret = mtd_do_writeoob(file, mtd, buf.start, buf.length,
				(void __user *)(uintptr_t)buf.usr_ptr,
				&buf_user->length);
		break;
	}

	case MEMREADOOB64:
	{
		struct mtd_oob_buf64 buf;
		struct mtd_oob_buf64 __user *buf_user = argp;

		if (copy_from_user(&buf, argp, sizeof(buf)))
			ret = -EFAULT;
		else
			ret = mtd_do_readoob(mtd, buf.start, buf.length,
				(void __user *)(uintptr_t)buf.usr_ptr,
				&buf_user->length);
		break;
	}

L
Linus Torvalds 已提交
656 657
	case MEMLOCK:
	{
658
		struct erase_info_user einfo;
L
Linus Torvalds 已提交
659

660
		if (copy_from_user(&einfo, argp, sizeof(einfo)))
L
Linus Torvalds 已提交
661 662 663 664 665
			return -EFAULT;

		if (!mtd->lock)
			ret = -EOPNOTSUPP;
		else
666
			ret = mtd->lock(mtd, einfo.start, einfo.length);
L
Linus Torvalds 已提交
667 668 669 670 671
		break;
	}

	case MEMUNLOCK:
	{
672
		struct erase_info_user einfo;
L
Linus Torvalds 已提交
673

674
		if (copy_from_user(&einfo, argp, sizeof(einfo)))
L
Linus Torvalds 已提交
675 676 677 678 679
			return -EFAULT;

		if (!mtd->unlock)
			ret = -EOPNOTSUPP;
		else
680
			ret = mtd->unlock(mtd, einfo.start, einfo.length);
L
Linus Torvalds 已提交
681 682 683
		break;
	}

684
	/* Legacy interface */
L
Linus Torvalds 已提交
685 686
	case MEMGETOOBSEL:
	{
687 688 689 690 691 692 693 694 695 696 697
		struct nand_oobinfo oi;

		if (!mtd->ecclayout)
			return -EOPNOTSUPP;
		if (mtd->ecclayout->eccbytes > ARRAY_SIZE(oi.eccpos))
			return -EINVAL;

		oi.useecc = MTD_NANDECC_AUTOPLACE;
		memcpy(&oi.eccpos, mtd->ecclayout->eccpos, sizeof(oi.eccpos));
		memcpy(&oi.oobfree, mtd->ecclayout->oobfree,
		       sizeof(oi.oobfree));
698
		oi.eccbytes = mtd->ecclayout->eccbytes;
699 700

		if (copy_to_user(argp, &oi, sizeof(struct nand_oobinfo)))
L
Linus Torvalds 已提交
701 702 703 704 705 706 707
			return -EFAULT;
		break;
	}

	case MEMGETBADBLOCK:
	{
		loff_t offs;
708

L
Linus Torvalds 已提交
709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730
		if (copy_from_user(&offs, argp, sizeof(loff_t)))
			return -EFAULT;
		if (!mtd->block_isbad)
			ret = -EOPNOTSUPP;
		else
			return mtd->block_isbad(mtd, offs);
		break;
	}

	case MEMSETBADBLOCK:
	{
		loff_t offs;

		if (copy_from_user(&offs, argp, sizeof(loff_t)))
			return -EFAULT;
		if (!mtd->block_markbad)
			ret = -EOPNOTSUPP;
		else
			return mtd->block_markbad(mtd, offs);
		break;
	}

D
David Brownell 已提交
731
#ifdef CONFIG_HAVE_MTD_OTP
732 733 734 735 736
	case OTPSELECT:
	{
		int mode;
		if (copy_from_user(&mode, argp, sizeof(int)))
			return -EFAULT;
737 738 739 740 741

		mfi->mode = MTD_MODE_NORMAL;

		ret = otp_select_filemode(mfi, mode);

742
		file->f_pos = 0;
743 744 745 746 747 748 749 750 751 752
		break;
	}

	case OTPGETREGIONCOUNT:
	case OTPGETREGIONINFO:
	{
		struct otp_info *buf = kmalloc(4096, GFP_KERNEL);
		if (!buf)
			return -ENOMEM;
		ret = -EOPNOTSUPP;
753 754
		switch (mfi->mode) {
		case MTD_MODE_OTP_FACTORY:
755 756 757 758 759 760 761
			if (mtd->get_fact_prot_info)
				ret = mtd->get_fact_prot_info(mtd, buf, 4096);
			break;
		case MTD_MODE_OTP_USER:
			if (mtd->get_user_prot_info)
				ret = mtd->get_user_prot_info(mtd, buf, 4096);
			break;
762 763
		default:
			break;
764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779
		}
		if (ret >= 0) {
			if (cmd == OTPGETREGIONCOUNT) {
				int nbr = ret / sizeof(struct otp_info);
				ret = copy_to_user(argp, &nbr, sizeof(int));
			} else
				ret = copy_to_user(argp, buf, ret);
			if (ret)
				ret = -EFAULT;
		}
		kfree(buf);
		break;
	}

	case OTPLOCK:
	{
780
		struct otp_info oinfo;
781

782
		if (mfi->mode != MTD_MODE_OTP_USER)
783
			return -EINVAL;
784
		if (copy_from_user(&oinfo, argp, sizeof(oinfo)))
785 786 787
			return -EFAULT;
		if (!mtd->lock_user_prot_reg)
			return -EOPNOTSUPP;
788
		ret = mtd->lock_user_prot_reg(mtd, oinfo.start, oinfo.length);
789 790 791 792
		break;
	}
#endif

793 794 795 796 797
	case ECCGETLAYOUT:
	{
		if (!mtd->ecclayout)
			return -EOPNOTSUPP;

798
		if (copy_to_user(argp, mtd->ecclayout,
799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835
				 sizeof(struct nand_ecclayout)))
			return -EFAULT;
		break;
	}

	case ECCGETSTATS:
	{
		if (copy_to_user(argp, &mtd->ecc_stats,
				 sizeof(struct mtd_ecc_stats)))
			return -EFAULT;
		break;
	}

	case MTDFILEMODE:
	{
		mfi->mode = 0;

		switch(arg) {
		case MTD_MODE_OTP_FACTORY:
		case MTD_MODE_OTP_USER:
			ret = otp_select_filemode(mfi, arg);
			break;

		case MTD_MODE_RAW:
			if (!mtd->read_oob || !mtd->write_oob)
				return -EOPNOTSUPP;
			mfi->mode = arg;

		case MTD_MODE_NORMAL:
			break;
		default:
			ret = -EINVAL;
		}
		file->f_pos = 0;
		break;
	}

L
Linus Torvalds 已提交
836 837 838 839 840 841 842
	default:
		ret = -ENOTTY;
	}

	return ret;
} /* memory_ioctl */

K
Kevin Cernekee 已提交
843 844 845 846 847 848 849 850 851 852 853 854 855 856
#ifdef CONFIG_COMPAT

struct mtd_oob_buf32 {
	u_int32_t start;
	u_int32_t length;
	compat_caddr_t ptr;	/* unsigned char* */
};

#define MEMWRITEOOB32		_IOWR('M', 3, struct mtd_oob_buf32)
#define MEMREADOOB32		_IOWR('M', 4, struct mtd_oob_buf32)

static long mtd_compat_ioctl(struct file *file, unsigned int cmd,
	unsigned long arg)
{
857
	struct inode *inode = file->f_path.dentry->d_inode;
K
Kevin Cernekee 已提交
858 859
	struct mtd_file_info *mfi = file->private_data;
	struct mtd_info *mtd = mfi->mtd;
860
	void __user *argp = compat_ptr(arg);
K
Kevin Cernekee 已提交
861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894
	int ret = 0;

	lock_kernel();

	switch (cmd) {
	case MEMWRITEOOB32:
	{
		struct mtd_oob_buf32 buf;
		struct mtd_oob_buf32 __user *buf_user = argp;

		if (copy_from_user(&buf, argp, sizeof(buf)))
			ret = -EFAULT;
		else
			ret = mtd_do_writeoob(file, mtd, buf.start,
				buf.length, compat_ptr(buf.ptr),
				&buf_user->length);
		break;
	}

	case MEMREADOOB32:
	{
		struct mtd_oob_buf32 buf;
		struct mtd_oob_buf32 __user *buf_user = argp;

		/* NOTE: writes return length to buf->start */
		if (copy_from_user(&buf, argp, sizeof(buf)))
			ret = -EFAULT;
		else
			ret = mtd_do_readoob(mtd, buf.start,
				buf.length, compat_ptr(buf.ptr),
				&buf_user->start);
		break;
	}
	default:
895
		ret = mtd_ioctl(inode, file, cmd, (unsigned long)argp);
K
Kevin Cernekee 已提交
896 897 898 899 900 901 902 903 904
	}

	unlock_kernel();

	return ret;
}

#endif /* CONFIG_COMPAT */

905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957
/*
 * try to determine where a shared mapping can be made
 * - only supported for NOMMU at the moment (MMU can't doesn't copy private
 *   mappings)
 */
#ifndef CONFIG_MMU
static unsigned long mtd_get_unmapped_area(struct file *file,
					   unsigned long addr,
					   unsigned long len,
					   unsigned long pgoff,
					   unsigned long flags)
{
	struct mtd_file_info *mfi = file->private_data;
	struct mtd_info *mtd = mfi->mtd;

	if (mtd->get_unmapped_area) {
		unsigned long offset;

		if (addr != 0)
			return (unsigned long) -EINVAL;

		if (len > mtd->size || pgoff >= (mtd->size >> PAGE_SHIFT))
			return (unsigned long) -EINVAL;

		offset = pgoff << PAGE_SHIFT;
		if (offset > mtd->size - len)
			return (unsigned long) -EINVAL;

		return mtd->get_unmapped_area(mtd, len, offset, flags);
	}

	/* can't map directly */
	return (unsigned long) -ENOSYS;
}
#endif

/*
 * set up a mapping for shared memory segments
 */
static int mtd_mmap(struct file *file, struct vm_area_struct *vma)
{
#ifdef CONFIG_MMU
	struct mtd_file_info *mfi = file->private_data;
	struct mtd_info *mtd = mfi->mtd;

	if (mtd->type == MTD_RAM || mtd->type == MTD_ROM)
		return 0;
	return -ENOSYS;
#else
	return vma->vm_flags & VM_SHARED ? 0 : -ENOSYS;
#endif
}

958
static const struct file_operations mtd_fops = {
L
Linus Torvalds 已提交
959 960 961 962 963
	.owner		= THIS_MODULE,
	.llseek		= mtd_lseek,
	.read		= mtd_read,
	.write		= mtd_write,
	.ioctl		= mtd_ioctl,
K
Kevin Cernekee 已提交
964 965 966
#ifdef CONFIG_COMPAT
	.compat_ioctl	= mtd_compat_ioctl,
#endif
L
Linus Torvalds 已提交
967 968
	.open		= mtd_open,
	.release	= mtd_close,
969 970 971 972
	.mmap		= mtd_mmap,
#ifndef CONFIG_MMU
	.get_unmapped_area = mtd_get_unmapped_area,
#endif
L
Linus Torvalds 已提交
973 974
};

975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008
static int mtd_inodefs_get_sb(struct file_system_type *fs_type, int flags,
                               const char *dev_name, void *data,
                               struct vfsmount *mnt)
{
        return get_sb_pseudo(fs_type, "mtd_inode:", NULL, MTD_INODE_FS_MAGIC,
                             mnt);
}

static struct file_system_type mtd_inodefs_type = {
       .name = "mtd_inodefs",
       .get_sb = mtd_inodefs_get_sb,
       .kill_sb = kill_anon_super,
};

static void mtdchar_notify_add(struct mtd_info *mtd)
{
}

static void mtdchar_notify_remove(struct mtd_info *mtd)
{
	struct inode *mtd_ino = ilookup(mtd_inode_mnt->mnt_sb, mtd->index);

	if (mtd_ino) {
		/* Destroy the inode if it exists */
		mtd_ino->i_nlink = 0;
		iput(mtd_ino);
	}
}

static struct mtd_notifier mtdchar_notifier = {
	.add = mtdchar_notify_add,
	.remove = mtdchar_notify_remove,
};

L
Linus Torvalds 已提交
1009 1010
static int __init init_mtdchar(void)
{
1011
	int ret;
D
David Brownell 已提交
1012

1013
	ret = __register_chrdev(MTD_CHAR_MAJOR, 0, 1 << MINORBITS,
1014
				   "mtd", &mtd_fops);
1015 1016 1017 1018
	if (ret < 0) {
		pr_notice("Can't allocate major number %d for "
				"Memory Technology Devices.\n", MTD_CHAR_MAJOR);
		return ret;
1019 1020
	}

1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041
	ret = register_filesystem(&mtd_inodefs_type);
	if (ret) {
		pr_notice("Can't register mtd_inodefs filesystem: %d\n", ret);
		goto err_unregister_chdev;
	}

	mtd_inode_mnt = kern_mount(&mtd_inodefs_type);
	if (IS_ERR(mtd_inode_mnt)) {
		ret = PTR_ERR(mtd_inode_mnt);
		pr_notice("Error mounting mtd_inodefs filesystem: %d\n", ret);
		goto err_unregister_filesystem;
	}
	register_mtd_user(&mtdchar_notifier);

	return ret;

err_unregister_filesystem:
	unregister_filesystem(&mtd_inodefs_type);
err_unregister_chdev:
	__unregister_chrdev(MTD_CHAR_MAJOR, 0, 1 << MINORBITS, "mtd");
	return ret;
L
Linus Torvalds 已提交
1042 1043 1044 1045
}

static void __exit cleanup_mtdchar(void)
{
1046 1047 1048
	unregister_mtd_user(&mtdchar_notifier);
	mntput(mtd_inode_mnt);
	unregister_filesystem(&mtd_inodefs_type);
1049
	__unregister_chrdev(MTD_CHAR_MAJOR, 0, 1 << MINORBITS, "mtd");
L
Linus Torvalds 已提交
1050 1051 1052 1053 1054
}

module_init(init_mtdchar);
module_exit(cleanup_mtdchar);

D
David Brownell 已提交
1055
MODULE_ALIAS_CHARDEV_MAJOR(MTD_CHAR_MAJOR);
L
Linus Torvalds 已提交
1056 1057 1058 1059

MODULE_LICENSE("GPL");
MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
MODULE_DESCRIPTION("Direct character-device access to MTD devices");
1060
MODULE_ALIAS_CHARDEV_MAJOR(MTD_CHAR_MAJOR);