xref: /openbmc/linux/drivers/mtd/mtdchar.c (revision 09bae3b6)
1 /*
2  * Copyright © 1999-2010 David Woodhouse <dwmw2@infradead.org>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; either version 2 of the License, or
7  * (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  * GNU 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; if not, write to the Free Software
16  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
17  *
18  */
19 
20 #include <linux/device.h>
21 #include <linux/fs.h>
22 #include <linux/mm.h>
23 #include <linux/err.h>
24 #include <linux/init.h>
25 #include <linux/kernel.h>
26 #include <linux/module.h>
27 #include <linux/slab.h>
28 #include <linux/sched.h>
29 #include <linux/mutex.h>
30 #include <linux/backing-dev.h>
31 #include <linux/compat.h>
32 #include <linux/mount.h>
33 #include <linux/blkpg.h>
34 #include <linux/magic.h>
35 #include <linux/major.h>
36 #include <linux/mtd/mtd.h>
37 #include <linux/mtd/partitions.h>
38 #include <linux/mtd/map.h>
39 
40 #include <linux/uaccess.h>
41 
42 #include "mtdcore.h"
43 
44 static DEFINE_MUTEX(mtd_mutex);
45 
46 /*
47  * Data structure to hold the pointer to the mtd device as well
48  * as mode information of various use cases.
49  */
50 struct mtd_file_info {
51 	struct mtd_info *mtd;
52 	enum mtd_file_modes mode;
53 };
54 
55 static loff_t mtdchar_lseek(struct file *file, loff_t offset, int orig)
56 {
57 	struct mtd_file_info *mfi = file->private_data;
58 	return fixed_size_llseek(file, offset, orig, mfi->mtd->size);
59 }
60 
61 static int mtdchar_open(struct inode *inode, struct file *file)
62 {
63 	int minor = iminor(inode);
64 	int devnum = minor >> 1;
65 	int ret = 0;
66 	struct mtd_info *mtd;
67 	struct mtd_file_info *mfi;
68 
69 	pr_debug("MTD_open\n");
70 
71 	/* You can't open the RO devices RW */
72 	if ((file->f_mode & FMODE_WRITE) && (minor & 1))
73 		return -EACCES;
74 
75 	mutex_lock(&mtd_mutex);
76 	mtd = get_mtd_device(NULL, devnum);
77 
78 	if (IS_ERR(mtd)) {
79 		ret = PTR_ERR(mtd);
80 		goto out;
81 	}
82 
83 	if (mtd->type == MTD_ABSENT) {
84 		ret = -ENODEV;
85 		goto out1;
86 	}
87 
88 	/* You can't open it RW if it's not a writeable device */
89 	if ((file->f_mode & FMODE_WRITE) && !(mtd->flags & MTD_WRITEABLE)) {
90 		ret = -EACCES;
91 		goto out1;
92 	}
93 
94 	mfi = kzalloc(sizeof(*mfi), GFP_KERNEL);
95 	if (!mfi) {
96 		ret = -ENOMEM;
97 		goto out1;
98 	}
99 	mfi->mtd = mtd;
100 	file->private_data = mfi;
101 	mutex_unlock(&mtd_mutex);
102 	return 0;
103 
104 out1:
105 	put_mtd_device(mtd);
106 out:
107 	mutex_unlock(&mtd_mutex);
108 	return ret;
109 } /* mtdchar_open */
110 
111 /*====================================================================*/
112 
113 static int mtdchar_close(struct inode *inode, struct file *file)
114 {
115 	struct mtd_file_info *mfi = file->private_data;
116 	struct mtd_info *mtd = mfi->mtd;
117 
118 	pr_debug("MTD_close\n");
119 
120 	/* Only sync if opened RW */
121 	if ((file->f_mode & FMODE_WRITE))
122 		mtd_sync(mtd);
123 
124 	put_mtd_device(mtd);
125 	file->private_data = NULL;
126 	kfree(mfi);
127 
128 	return 0;
129 } /* mtdchar_close */
130 
131 /* Back in June 2001, dwmw2 wrote:
132  *
133  *   FIXME: This _really_ needs to die. In 2.5, we should lock the
134  *   userspace buffer down and use it directly with readv/writev.
135  *
136  * The implementation below, using mtd_kmalloc_up_to, mitigates
137  * allocation failures when the system is under low-memory situations
138  * or if memory is highly fragmented at the cost of reducing the
139  * performance of the requested transfer due to a smaller buffer size.
140  *
141  * A more complex but more memory-efficient implementation based on
142  * get_user_pages and iovecs to cover extents of those pages is a
143  * longer-term goal, as intimated by dwmw2 above. However, for the
144  * write case, this requires yet more complex head and tail transfer
145  * handling when those head and tail offsets and sizes are such that
146  * alignment requirements are not met in the NAND subdriver.
147  */
148 
149 static ssize_t mtdchar_read(struct file *file, char __user *buf, size_t count,
150 			loff_t *ppos)
151 {
152 	struct mtd_file_info *mfi = file->private_data;
153 	struct mtd_info *mtd = mfi->mtd;
154 	size_t retlen;
155 	size_t total_retlen=0;
156 	int ret=0;
157 	int len;
158 	size_t size = count;
159 	char *kbuf;
160 
161 	pr_debug("MTD_read\n");
162 
163 	if (*ppos + count > mtd->size) {
164 		if (*ppos < mtd->size)
165 			count = mtd->size - *ppos;
166 		else
167 			count = 0;
168 	}
169 
170 	if (!count)
171 		return 0;
172 
173 	kbuf = mtd_kmalloc_up_to(mtd, &size);
174 	if (!kbuf)
175 		return -ENOMEM;
176 
177 	while (count) {
178 		len = min_t(size_t, count, size);
179 
180 		switch (mfi->mode) {
181 		case MTD_FILE_MODE_OTP_FACTORY:
182 			ret = mtd_read_fact_prot_reg(mtd, *ppos, len,
183 						     &retlen, kbuf);
184 			break;
185 		case MTD_FILE_MODE_OTP_USER:
186 			ret = mtd_read_user_prot_reg(mtd, *ppos, len,
187 						     &retlen, kbuf);
188 			break;
189 		case MTD_FILE_MODE_RAW:
190 		{
191 			struct mtd_oob_ops ops;
192 
193 			ops.mode = MTD_OPS_RAW;
194 			ops.datbuf = kbuf;
195 			ops.oobbuf = NULL;
196 			ops.len = len;
197 
198 			ret = mtd_read_oob(mtd, *ppos, &ops);
199 			retlen = ops.retlen;
200 			break;
201 		}
202 		default:
203 			ret = mtd_read(mtd, *ppos, len, &retlen, kbuf);
204 		}
205 		/* Nand returns -EBADMSG on ECC errors, but it returns
206 		 * the data. For our userspace tools it is important
207 		 * to dump areas with ECC errors!
208 		 * For kernel internal usage it also might return -EUCLEAN
209 		 * to signal the caller that a bitflip has occurred and has
210 		 * been corrected by the ECC algorithm.
211 		 * Userspace software which accesses NAND this way
212 		 * must be aware of the fact that it deals with NAND
213 		 */
214 		if (!ret || mtd_is_bitflip_or_eccerr(ret)) {
215 			*ppos += retlen;
216 			if (copy_to_user(buf, kbuf, retlen)) {
217 				kfree(kbuf);
218 				return -EFAULT;
219 			}
220 			else
221 				total_retlen += retlen;
222 
223 			count -= retlen;
224 			buf += retlen;
225 			if (retlen == 0)
226 				count = 0;
227 		}
228 		else {
229 			kfree(kbuf);
230 			return ret;
231 		}
232 
233 	}
234 
235 	kfree(kbuf);
236 	return total_retlen;
237 } /* mtdchar_read */
238 
239 static ssize_t mtdchar_write(struct file *file, const char __user *buf, size_t count,
240 			loff_t *ppos)
241 {
242 	struct mtd_file_info *mfi = file->private_data;
243 	struct mtd_info *mtd = mfi->mtd;
244 	size_t size = count;
245 	char *kbuf;
246 	size_t retlen;
247 	size_t total_retlen=0;
248 	int ret=0;
249 	int len;
250 
251 	pr_debug("MTD_write\n");
252 
253 	if (*ppos >= mtd->size)
254 		return -ENOSPC;
255 
256 	if (*ppos + count > mtd->size)
257 		count = mtd->size - *ppos;
258 
259 	if (!count)
260 		return 0;
261 
262 	kbuf = mtd_kmalloc_up_to(mtd, &size);
263 	if (!kbuf)
264 		return -ENOMEM;
265 
266 	while (count) {
267 		len = min_t(size_t, count, size);
268 
269 		if (copy_from_user(kbuf, buf, len)) {
270 			kfree(kbuf);
271 			return -EFAULT;
272 		}
273 
274 		switch (mfi->mode) {
275 		case MTD_FILE_MODE_OTP_FACTORY:
276 			ret = -EROFS;
277 			break;
278 		case MTD_FILE_MODE_OTP_USER:
279 			ret = mtd_write_user_prot_reg(mtd, *ppos, len,
280 						      &retlen, kbuf);
281 			break;
282 
283 		case MTD_FILE_MODE_RAW:
284 		{
285 			struct mtd_oob_ops ops;
286 
287 			ops.mode = MTD_OPS_RAW;
288 			ops.datbuf = kbuf;
289 			ops.oobbuf = NULL;
290 			ops.ooboffs = 0;
291 			ops.len = len;
292 
293 			ret = mtd_write_oob(mtd, *ppos, &ops);
294 			retlen = ops.retlen;
295 			break;
296 		}
297 
298 		default:
299 			ret = mtd_write(mtd, *ppos, len, &retlen, kbuf);
300 		}
301 
302 		/*
303 		 * Return -ENOSPC only if no data could be written at all.
304 		 * Otherwise just return the number of bytes that actually
305 		 * have been written.
306 		 */
307 		if ((ret == -ENOSPC) && (total_retlen))
308 			break;
309 
310 		if (!ret) {
311 			*ppos += retlen;
312 			total_retlen += retlen;
313 			count -= retlen;
314 			buf += retlen;
315 		}
316 		else {
317 			kfree(kbuf);
318 			return ret;
319 		}
320 	}
321 
322 	kfree(kbuf);
323 	return total_retlen;
324 } /* mtdchar_write */
325 
326 /*======================================================================
327 
328     IOCTL calls for getting device parameters.
329 
330 ======================================================================*/
331 
332 static int otp_select_filemode(struct mtd_file_info *mfi, int mode)
333 {
334 	struct mtd_info *mtd = mfi->mtd;
335 	size_t retlen;
336 
337 	switch (mode) {
338 	case MTD_OTP_FACTORY:
339 		if (mtd_read_fact_prot_reg(mtd, -1, 0, &retlen, NULL) ==
340 				-EOPNOTSUPP)
341 			return -EOPNOTSUPP;
342 
343 		mfi->mode = MTD_FILE_MODE_OTP_FACTORY;
344 		break;
345 	case MTD_OTP_USER:
346 		if (mtd_read_user_prot_reg(mtd, -1, 0, &retlen, NULL) ==
347 				-EOPNOTSUPP)
348 			return -EOPNOTSUPP;
349 
350 		mfi->mode = MTD_FILE_MODE_OTP_USER;
351 		break;
352 	case MTD_OTP_OFF:
353 		mfi->mode = MTD_FILE_MODE_NORMAL;
354 		break;
355 	default:
356 		return -EINVAL;
357 	}
358 
359 	return 0;
360 }
361 
362 static int mtdchar_writeoob(struct file *file, struct mtd_info *mtd,
363 	uint64_t start, uint32_t length, void __user *ptr,
364 	uint32_t __user *retp)
365 {
366 	struct mtd_file_info *mfi = file->private_data;
367 	struct mtd_oob_ops ops;
368 	uint32_t retlen;
369 	int ret = 0;
370 
371 	if (!(file->f_mode & FMODE_WRITE))
372 		return -EPERM;
373 
374 	if (length > 4096)
375 		return -EINVAL;
376 
377 	if (!mtd->_write_oob)
378 		return -EOPNOTSUPP;
379 
380 	ops.ooblen = length;
381 	ops.ooboffs = start & (mtd->writesize - 1);
382 	ops.datbuf = NULL;
383 	ops.mode = (mfi->mode == MTD_FILE_MODE_RAW) ? MTD_OPS_RAW :
384 		MTD_OPS_PLACE_OOB;
385 
386 	if (ops.ooboffs && ops.ooblen > (mtd->oobsize - ops.ooboffs))
387 		return -EINVAL;
388 
389 	ops.oobbuf = memdup_user(ptr, length);
390 	if (IS_ERR(ops.oobbuf))
391 		return PTR_ERR(ops.oobbuf);
392 
393 	start &= ~((uint64_t)mtd->writesize - 1);
394 	ret = mtd_write_oob(mtd, start, &ops);
395 
396 	if (ops.oobretlen > 0xFFFFFFFFU)
397 		ret = -EOVERFLOW;
398 	retlen = ops.oobretlen;
399 	if (copy_to_user(retp, &retlen, sizeof(length)))
400 		ret = -EFAULT;
401 
402 	kfree(ops.oobbuf);
403 	return ret;
404 }
405 
406 static int mtdchar_readoob(struct file *file, struct mtd_info *mtd,
407 	uint64_t start, uint32_t length, void __user *ptr,
408 	uint32_t __user *retp)
409 {
410 	struct mtd_file_info *mfi = file->private_data;
411 	struct mtd_oob_ops ops;
412 	int ret = 0;
413 
414 	if (length > 4096)
415 		return -EINVAL;
416 
417 	ops.ooblen = length;
418 	ops.ooboffs = start & (mtd->writesize - 1);
419 	ops.datbuf = NULL;
420 	ops.mode = (mfi->mode == MTD_FILE_MODE_RAW) ? MTD_OPS_RAW :
421 		MTD_OPS_PLACE_OOB;
422 
423 	if (ops.ooboffs && ops.ooblen > (mtd->oobsize - ops.ooboffs))
424 		return -EINVAL;
425 
426 	ops.oobbuf = kmalloc(length, GFP_KERNEL);
427 	if (!ops.oobbuf)
428 		return -ENOMEM;
429 
430 	start &= ~((uint64_t)mtd->writesize - 1);
431 	ret = mtd_read_oob(mtd, start, &ops);
432 
433 	if (put_user(ops.oobretlen, retp))
434 		ret = -EFAULT;
435 	else if (ops.oobretlen && copy_to_user(ptr, ops.oobbuf,
436 					    ops.oobretlen))
437 		ret = -EFAULT;
438 
439 	kfree(ops.oobbuf);
440 
441 	/*
442 	 * NAND returns -EBADMSG on ECC errors, but it returns the OOB
443 	 * data. For our userspace tools it is important to dump areas
444 	 * with ECC errors!
445 	 * For kernel internal usage it also might return -EUCLEAN
446 	 * to signal the caller that a bitflip has occurred and has
447 	 * been corrected by the ECC algorithm.
448 	 *
449 	 * Note: currently the standard NAND function, nand_read_oob_std,
450 	 * does not calculate ECC for the OOB area, so do not rely on
451 	 * this behavior unless you have replaced it with your own.
452 	 */
453 	if (mtd_is_bitflip_or_eccerr(ret))
454 		return 0;
455 
456 	return ret;
457 }
458 
459 /*
460  * Copies (and truncates, if necessary) OOB layout information to the
461  * deprecated layout struct, nand_ecclayout_user. This is necessary only to
462  * support the deprecated API ioctl ECCGETLAYOUT while allowing all new
463  * functionality to use mtd_ooblayout_ops flexibly (i.e. mtd_ooblayout_ops
464  * can describe any kind of OOB layout with almost zero overhead from a
465  * memory usage point of view).
466  */
467 static int shrink_ecclayout(struct mtd_info *mtd,
468 			    struct nand_ecclayout_user *to)
469 {
470 	struct mtd_oob_region oobregion;
471 	int i, section = 0, ret;
472 
473 	if (!mtd || !to)
474 		return -EINVAL;
475 
476 	memset(to, 0, sizeof(*to));
477 
478 	to->eccbytes = 0;
479 	for (i = 0; i < MTD_MAX_ECCPOS_ENTRIES;) {
480 		u32 eccpos;
481 
482 		ret = mtd_ooblayout_ecc(mtd, section++, &oobregion);
483 		if (ret < 0) {
484 			if (ret != -ERANGE)
485 				return ret;
486 
487 			break;
488 		}
489 
490 		eccpos = oobregion.offset;
491 		for (; i < MTD_MAX_ECCPOS_ENTRIES &&
492 		       eccpos < oobregion.offset + oobregion.length; i++) {
493 			to->eccpos[i] = eccpos++;
494 			to->eccbytes++;
495 		}
496 	}
497 
498 	for (i = 0; i < MTD_MAX_OOBFREE_ENTRIES; i++) {
499 		ret = mtd_ooblayout_free(mtd, i, &oobregion);
500 		if (ret < 0) {
501 			if (ret != -ERANGE)
502 				return ret;
503 
504 			break;
505 		}
506 
507 		to->oobfree[i].offset = oobregion.offset;
508 		to->oobfree[i].length = oobregion.length;
509 		to->oobavail += to->oobfree[i].length;
510 	}
511 
512 	return 0;
513 }
514 
515 static int get_oobinfo(struct mtd_info *mtd, struct nand_oobinfo *to)
516 {
517 	struct mtd_oob_region oobregion;
518 	int i, section = 0, ret;
519 
520 	if (!mtd || !to)
521 		return -EINVAL;
522 
523 	memset(to, 0, sizeof(*to));
524 
525 	to->eccbytes = 0;
526 	for (i = 0; i < ARRAY_SIZE(to->eccpos);) {
527 		u32 eccpos;
528 
529 		ret = mtd_ooblayout_ecc(mtd, section++, &oobregion);
530 		if (ret < 0) {
531 			if (ret != -ERANGE)
532 				return ret;
533 
534 			break;
535 		}
536 
537 		if (oobregion.length + i > ARRAY_SIZE(to->eccpos))
538 			return -EINVAL;
539 
540 		eccpos = oobregion.offset;
541 		for (; eccpos < oobregion.offset + oobregion.length; i++) {
542 			to->eccpos[i] = eccpos++;
543 			to->eccbytes++;
544 		}
545 	}
546 
547 	for (i = 0; i < 8; i++) {
548 		ret = mtd_ooblayout_free(mtd, i, &oobregion);
549 		if (ret < 0) {
550 			if (ret != -ERANGE)
551 				return ret;
552 
553 			break;
554 		}
555 
556 		to->oobfree[i][0] = oobregion.offset;
557 		to->oobfree[i][1] = oobregion.length;
558 	}
559 
560 	to->useecc = MTD_NANDECC_AUTOPLACE;
561 
562 	return 0;
563 }
564 
565 static int mtdchar_blkpg_ioctl(struct mtd_info *mtd,
566 			       struct blkpg_ioctl_arg *arg)
567 {
568 	struct blkpg_partition p;
569 
570 	if (!capable(CAP_SYS_ADMIN))
571 		return -EPERM;
572 
573 	if (copy_from_user(&p, arg->data, sizeof(p)))
574 		return -EFAULT;
575 
576 	switch (arg->op) {
577 	case BLKPG_ADD_PARTITION:
578 
579 		/* Only master mtd device must be used to add partitions */
580 		if (mtd_is_partition(mtd))
581 			return -EINVAL;
582 
583 		/* Sanitize user input */
584 		p.devname[BLKPG_DEVNAMELTH - 1] = '\0';
585 
586 		return mtd_add_partition(mtd, p.devname, p.start, p.length);
587 
588 	case BLKPG_DEL_PARTITION:
589 
590 		if (p.pno < 0)
591 			return -EINVAL;
592 
593 		return mtd_del_partition(mtd, p.pno);
594 
595 	default:
596 		return -EINVAL;
597 	}
598 }
599 
600 static int mtdchar_write_ioctl(struct mtd_info *mtd,
601 		struct mtd_write_req __user *argp)
602 {
603 	struct mtd_write_req req;
604 	struct mtd_oob_ops ops;
605 	const void __user *usr_data, *usr_oob;
606 	int ret;
607 
608 	if (copy_from_user(&req, argp, sizeof(req)))
609 		return -EFAULT;
610 
611 	usr_data = (const void __user *)(uintptr_t)req.usr_data;
612 	usr_oob = (const void __user *)(uintptr_t)req.usr_oob;
613 
614 	if (!mtd->_write_oob)
615 		return -EOPNOTSUPP;
616 
617 	ops.mode = req.mode;
618 	ops.len = (size_t)req.len;
619 	ops.ooblen = (size_t)req.ooblen;
620 	ops.ooboffs = 0;
621 
622 	if (usr_data) {
623 		ops.datbuf = memdup_user(usr_data, ops.len);
624 		if (IS_ERR(ops.datbuf))
625 			return PTR_ERR(ops.datbuf);
626 	} else {
627 		ops.datbuf = NULL;
628 	}
629 
630 	if (usr_oob) {
631 		ops.oobbuf = memdup_user(usr_oob, ops.ooblen);
632 		if (IS_ERR(ops.oobbuf)) {
633 			kfree(ops.datbuf);
634 			return PTR_ERR(ops.oobbuf);
635 		}
636 	} else {
637 		ops.oobbuf = NULL;
638 	}
639 
640 	ret = mtd_write_oob(mtd, (loff_t)req.start, &ops);
641 
642 	kfree(ops.datbuf);
643 	kfree(ops.oobbuf);
644 
645 	return ret;
646 }
647 
648 static int mtdchar_ioctl(struct file *file, u_int cmd, u_long arg)
649 {
650 	struct mtd_file_info *mfi = file->private_data;
651 	struct mtd_info *mtd = mfi->mtd;
652 	void __user *argp = (void __user *)arg;
653 	int ret = 0;
654 	struct mtd_info_user info;
655 
656 	pr_debug("MTD_ioctl\n");
657 
658 	switch (cmd) {
659 	case MEMGETREGIONCOUNT:
660 		if (copy_to_user(argp, &(mtd->numeraseregions), sizeof(int)))
661 			return -EFAULT;
662 		break;
663 
664 	case MEMGETREGIONINFO:
665 	{
666 		uint32_t ur_idx;
667 		struct mtd_erase_region_info *kr;
668 		struct region_info_user __user *ur = argp;
669 
670 		if (get_user(ur_idx, &(ur->regionindex)))
671 			return -EFAULT;
672 
673 		if (ur_idx >= mtd->numeraseregions)
674 			return -EINVAL;
675 
676 		kr = &(mtd->eraseregions[ur_idx]);
677 
678 		if (put_user(kr->offset, &(ur->offset))
679 		    || put_user(kr->erasesize, &(ur->erasesize))
680 		    || put_user(kr->numblocks, &(ur->numblocks)))
681 			return -EFAULT;
682 
683 		break;
684 	}
685 
686 	case MEMGETINFO:
687 		memset(&info, 0, sizeof(info));
688 		info.type	= mtd->type;
689 		info.flags	= mtd->flags;
690 		info.size	= mtd->size;
691 		info.erasesize	= mtd->erasesize;
692 		info.writesize	= mtd->writesize;
693 		info.oobsize	= mtd->oobsize;
694 		/* The below field is obsolete */
695 		info.padding	= 0;
696 		if (copy_to_user(argp, &info, sizeof(struct mtd_info_user)))
697 			return -EFAULT;
698 		break;
699 
700 	case MEMERASE:
701 	case MEMERASE64:
702 	{
703 		struct erase_info *erase;
704 
705 		if(!(file->f_mode & FMODE_WRITE))
706 			return -EPERM;
707 
708 		erase=kzalloc(sizeof(struct erase_info),GFP_KERNEL);
709 		if (!erase)
710 			ret = -ENOMEM;
711 		else {
712 			if (cmd == MEMERASE64) {
713 				struct erase_info_user64 einfo64;
714 
715 				if (copy_from_user(&einfo64, argp,
716 					    sizeof(struct erase_info_user64))) {
717 					kfree(erase);
718 					return -EFAULT;
719 				}
720 				erase->addr = einfo64.start;
721 				erase->len = einfo64.length;
722 			} else {
723 				struct erase_info_user einfo32;
724 
725 				if (copy_from_user(&einfo32, argp,
726 					    sizeof(struct erase_info_user))) {
727 					kfree(erase);
728 					return -EFAULT;
729 				}
730 				erase->addr = einfo32.start;
731 				erase->len = einfo32.length;
732 			}
733 
734 			ret = mtd_erase(mtd, erase);
735 			kfree(erase);
736 		}
737 		break;
738 	}
739 
740 	case MEMWRITEOOB:
741 	{
742 		struct mtd_oob_buf buf;
743 		struct mtd_oob_buf __user *buf_user = argp;
744 
745 		/* NOTE: writes return length to buf_user->length */
746 		if (copy_from_user(&buf, argp, sizeof(buf)))
747 			ret = -EFAULT;
748 		else
749 			ret = mtdchar_writeoob(file, mtd, buf.start, buf.length,
750 				buf.ptr, &buf_user->length);
751 		break;
752 	}
753 
754 	case MEMREADOOB:
755 	{
756 		struct mtd_oob_buf buf;
757 		struct mtd_oob_buf __user *buf_user = argp;
758 
759 		/* NOTE: writes return length to buf_user->start */
760 		if (copy_from_user(&buf, argp, sizeof(buf)))
761 			ret = -EFAULT;
762 		else
763 			ret = mtdchar_readoob(file, mtd, buf.start, buf.length,
764 				buf.ptr, &buf_user->start);
765 		break;
766 	}
767 
768 	case MEMWRITEOOB64:
769 	{
770 		struct mtd_oob_buf64 buf;
771 		struct mtd_oob_buf64 __user *buf_user = argp;
772 
773 		if (copy_from_user(&buf, argp, sizeof(buf)))
774 			ret = -EFAULT;
775 		else
776 			ret = mtdchar_writeoob(file, mtd, buf.start, buf.length,
777 				(void __user *)(uintptr_t)buf.usr_ptr,
778 				&buf_user->length);
779 		break;
780 	}
781 
782 	case MEMREADOOB64:
783 	{
784 		struct mtd_oob_buf64 buf;
785 		struct mtd_oob_buf64 __user *buf_user = argp;
786 
787 		if (copy_from_user(&buf, argp, sizeof(buf)))
788 			ret = -EFAULT;
789 		else
790 			ret = mtdchar_readoob(file, mtd, buf.start, buf.length,
791 				(void __user *)(uintptr_t)buf.usr_ptr,
792 				&buf_user->length);
793 		break;
794 	}
795 
796 	case MEMWRITE:
797 	{
798 		ret = mtdchar_write_ioctl(mtd,
799 		      (struct mtd_write_req __user *)arg);
800 		break;
801 	}
802 
803 	case MEMLOCK:
804 	{
805 		struct erase_info_user einfo;
806 
807 		if (copy_from_user(&einfo, argp, sizeof(einfo)))
808 			return -EFAULT;
809 
810 		ret = mtd_lock(mtd, einfo.start, einfo.length);
811 		break;
812 	}
813 
814 	case MEMUNLOCK:
815 	{
816 		struct erase_info_user einfo;
817 
818 		if (copy_from_user(&einfo, argp, sizeof(einfo)))
819 			return -EFAULT;
820 
821 		ret = mtd_unlock(mtd, einfo.start, einfo.length);
822 		break;
823 	}
824 
825 	case MEMISLOCKED:
826 	{
827 		struct erase_info_user einfo;
828 
829 		if (copy_from_user(&einfo, argp, sizeof(einfo)))
830 			return -EFAULT;
831 
832 		ret = mtd_is_locked(mtd, einfo.start, einfo.length);
833 		break;
834 	}
835 
836 	/* Legacy interface */
837 	case MEMGETOOBSEL:
838 	{
839 		struct nand_oobinfo oi;
840 
841 		if (!mtd->ooblayout)
842 			return -EOPNOTSUPP;
843 
844 		ret = get_oobinfo(mtd, &oi);
845 		if (ret)
846 			return ret;
847 
848 		if (copy_to_user(argp, &oi, sizeof(struct nand_oobinfo)))
849 			return -EFAULT;
850 		break;
851 	}
852 
853 	case MEMGETBADBLOCK:
854 	{
855 		loff_t offs;
856 
857 		if (copy_from_user(&offs, argp, sizeof(loff_t)))
858 			return -EFAULT;
859 		return mtd_block_isbad(mtd, offs);
860 		break;
861 	}
862 
863 	case MEMSETBADBLOCK:
864 	{
865 		loff_t offs;
866 
867 		if (copy_from_user(&offs, argp, sizeof(loff_t)))
868 			return -EFAULT;
869 		return mtd_block_markbad(mtd, offs);
870 		break;
871 	}
872 
873 	case OTPSELECT:
874 	{
875 		int mode;
876 		if (copy_from_user(&mode, argp, sizeof(int)))
877 			return -EFAULT;
878 
879 		mfi->mode = MTD_FILE_MODE_NORMAL;
880 
881 		ret = otp_select_filemode(mfi, mode);
882 
883 		file->f_pos = 0;
884 		break;
885 	}
886 
887 	case OTPGETREGIONCOUNT:
888 	case OTPGETREGIONINFO:
889 	{
890 		struct otp_info *buf = kmalloc(4096, GFP_KERNEL);
891 		size_t retlen;
892 		if (!buf)
893 			return -ENOMEM;
894 		switch (mfi->mode) {
895 		case MTD_FILE_MODE_OTP_FACTORY:
896 			ret = mtd_get_fact_prot_info(mtd, 4096, &retlen, buf);
897 			break;
898 		case MTD_FILE_MODE_OTP_USER:
899 			ret = mtd_get_user_prot_info(mtd, 4096, &retlen, buf);
900 			break;
901 		default:
902 			ret = -EINVAL;
903 			break;
904 		}
905 		if (!ret) {
906 			if (cmd == OTPGETREGIONCOUNT) {
907 				int nbr = retlen / sizeof(struct otp_info);
908 				ret = copy_to_user(argp, &nbr, sizeof(int));
909 			} else
910 				ret = copy_to_user(argp, buf, retlen);
911 			if (ret)
912 				ret = -EFAULT;
913 		}
914 		kfree(buf);
915 		break;
916 	}
917 
918 	case OTPLOCK:
919 	{
920 		struct otp_info oinfo;
921 
922 		if (mfi->mode != MTD_FILE_MODE_OTP_USER)
923 			return -EINVAL;
924 		if (copy_from_user(&oinfo, argp, sizeof(oinfo)))
925 			return -EFAULT;
926 		ret = mtd_lock_user_prot_reg(mtd, oinfo.start, oinfo.length);
927 		break;
928 	}
929 
930 	/* This ioctl is being deprecated - it truncates the ECC layout */
931 	case ECCGETLAYOUT:
932 	{
933 		struct nand_ecclayout_user *usrlay;
934 
935 		if (!mtd->ooblayout)
936 			return -EOPNOTSUPP;
937 
938 		usrlay = kmalloc(sizeof(*usrlay), GFP_KERNEL);
939 		if (!usrlay)
940 			return -ENOMEM;
941 
942 		shrink_ecclayout(mtd, usrlay);
943 
944 		if (copy_to_user(argp, usrlay, sizeof(*usrlay)))
945 			ret = -EFAULT;
946 		kfree(usrlay);
947 		break;
948 	}
949 
950 	case ECCGETSTATS:
951 	{
952 		if (copy_to_user(argp, &mtd->ecc_stats,
953 				 sizeof(struct mtd_ecc_stats)))
954 			return -EFAULT;
955 		break;
956 	}
957 
958 	case MTDFILEMODE:
959 	{
960 		mfi->mode = 0;
961 
962 		switch(arg) {
963 		case MTD_FILE_MODE_OTP_FACTORY:
964 		case MTD_FILE_MODE_OTP_USER:
965 			ret = otp_select_filemode(mfi, arg);
966 			break;
967 
968 		case MTD_FILE_MODE_RAW:
969 			if (!mtd_has_oob(mtd))
970 				return -EOPNOTSUPP;
971 			mfi->mode = arg;
972 
973 		case MTD_FILE_MODE_NORMAL:
974 			break;
975 		default:
976 			ret = -EINVAL;
977 		}
978 		file->f_pos = 0;
979 		break;
980 	}
981 
982 	case BLKPG:
983 	{
984 		struct blkpg_ioctl_arg __user *blk_arg = argp;
985 		struct blkpg_ioctl_arg a;
986 
987 		if (copy_from_user(&a, blk_arg, sizeof(a)))
988 			ret = -EFAULT;
989 		else
990 			ret = mtdchar_blkpg_ioctl(mtd, &a);
991 		break;
992 	}
993 
994 	case BLKRRPART:
995 	{
996 		/* No reread partition feature. Just return ok */
997 		ret = 0;
998 		break;
999 	}
1000 
1001 	default:
1002 		ret = -ENOTTY;
1003 	}
1004 
1005 	return ret;
1006 } /* memory_ioctl */
1007 
1008 static long mtdchar_unlocked_ioctl(struct file *file, u_int cmd, u_long arg)
1009 {
1010 	int ret;
1011 
1012 	mutex_lock(&mtd_mutex);
1013 	ret = mtdchar_ioctl(file, cmd, arg);
1014 	mutex_unlock(&mtd_mutex);
1015 
1016 	return ret;
1017 }
1018 
1019 #ifdef CONFIG_COMPAT
1020 
1021 struct mtd_oob_buf32 {
1022 	u_int32_t start;
1023 	u_int32_t length;
1024 	compat_caddr_t ptr;	/* unsigned char* */
1025 };
1026 
1027 #define MEMWRITEOOB32		_IOWR('M', 3, struct mtd_oob_buf32)
1028 #define MEMREADOOB32		_IOWR('M', 4, struct mtd_oob_buf32)
1029 
1030 static long mtdchar_compat_ioctl(struct file *file, unsigned int cmd,
1031 	unsigned long arg)
1032 {
1033 	struct mtd_file_info *mfi = file->private_data;
1034 	struct mtd_info *mtd = mfi->mtd;
1035 	void __user *argp = compat_ptr(arg);
1036 	int ret = 0;
1037 
1038 	mutex_lock(&mtd_mutex);
1039 
1040 	switch (cmd) {
1041 	case MEMWRITEOOB32:
1042 	{
1043 		struct mtd_oob_buf32 buf;
1044 		struct mtd_oob_buf32 __user *buf_user = argp;
1045 
1046 		if (copy_from_user(&buf, argp, sizeof(buf)))
1047 			ret = -EFAULT;
1048 		else
1049 			ret = mtdchar_writeoob(file, mtd, buf.start,
1050 				buf.length, compat_ptr(buf.ptr),
1051 				&buf_user->length);
1052 		break;
1053 	}
1054 
1055 	case MEMREADOOB32:
1056 	{
1057 		struct mtd_oob_buf32 buf;
1058 		struct mtd_oob_buf32 __user *buf_user = argp;
1059 
1060 		/* NOTE: writes return length to buf->start */
1061 		if (copy_from_user(&buf, argp, sizeof(buf)))
1062 			ret = -EFAULT;
1063 		else
1064 			ret = mtdchar_readoob(file, mtd, buf.start,
1065 				buf.length, compat_ptr(buf.ptr),
1066 				&buf_user->start);
1067 		break;
1068 	}
1069 
1070 	case BLKPG:
1071 	{
1072 		/* Convert from blkpg_compat_ioctl_arg to blkpg_ioctl_arg */
1073 		struct blkpg_compat_ioctl_arg __user *uarg = argp;
1074 		struct blkpg_compat_ioctl_arg compat_arg;
1075 		struct blkpg_ioctl_arg a;
1076 
1077 		if (copy_from_user(&compat_arg, uarg, sizeof(compat_arg))) {
1078 			ret = -EFAULT;
1079 			break;
1080 		}
1081 
1082 		memset(&a, 0, sizeof(a));
1083 		a.op = compat_arg.op;
1084 		a.flags = compat_arg.flags;
1085 		a.datalen = compat_arg.datalen;
1086 		a.data = compat_ptr(compat_arg.data);
1087 
1088 		ret = mtdchar_blkpg_ioctl(mtd, &a);
1089 		break;
1090 	}
1091 
1092 	default:
1093 		ret = mtdchar_ioctl(file, cmd, (unsigned long)argp);
1094 	}
1095 
1096 	mutex_unlock(&mtd_mutex);
1097 
1098 	return ret;
1099 }
1100 
1101 #endif /* CONFIG_COMPAT */
1102 
1103 /*
1104  * try to determine where a shared mapping can be made
1105  * - only supported for NOMMU at the moment (MMU can't doesn't copy private
1106  *   mappings)
1107  */
1108 #ifndef CONFIG_MMU
1109 static unsigned long mtdchar_get_unmapped_area(struct file *file,
1110 					   unsigned long addr,
1111 					   unsigned long len,
1112 					   unsigned long pgoff,
1113 					   unsigned long flags)
1114 {
1115 	struct mtd_file_info *mfi = file->private_data;
1116 	struct mtd_info *mtd = mfi->mtd;
1117 	unsigned long offset;
1118 	int ret;
1119 
1120 	if (addr != 0)
1121 		return (unsigned long) -EINVAL;
1122 
1123 	if (len > mtd->size || pgoff >= (mtd->size >> PAGE_SHIFT))
1124 		return (unsigned long) -EINVAL;
1125 
1126 	offset = pgoff << PAGE_SHIFT;
1127 	if (offset > mtd->size - len)
1128 		return (unsigned long) -EINVAL;
1129 
1130 	ret = mtd_get_unmapped_area(mtd, len, offset, flags);
1131 	return ret == -EOPNOTSUPP ? -ENODEV : ret;
1132 }
1133 
1134 static unsigned mtdchar_mmap_capabilities(struct file *file)
1135 {
1136 	struct mtd_file_info *mfi = file->private_data;
1137 
1138 	return mtd_mmap_capabilities(mfi->mtd);
1139 }
1140 #endif
1141 
1142 /*
1143  * set up a mapping for shared memory segments
1144  */
1145 static int mtdchar_mmap(struct file *file, struct vm_area_struct *vma)
1146 {
1147 #ifdef CONFIG_MMU
1148 	struct mtd_file_info *mfi = file->private_data;
1149 	struct mtd_info *mtd = mfi->mtd;
1150 	struct map_info *map = mtd->priv;
1151 
1152         /* This is broken because it assumes the MTD device is map-based
1153 	   and that mtd->priv is a valid struct map_info.  It should be
1154 	   replaced with something that uses the mtd_get_unmapped_area()
1155 	   operation properly. */
1156 	if (0 /*mtd->type == MTD_RAM || mtd->type == MTD_ROM*/) {
1157 #ifdef pgprot_noncached
1158 		if (file->f_flags & O_DSYNC || map->phys >= __pa(high_memory))
1159 			vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
1160 #endif
1161 		return vm_iomap_memory(vma, map->phys, map->size);
1162 	}
1163 	return -ENODEV;
1164 #else
1165 	return vma->vm_flags & VM_SHARED ? 0 : -EACCES;
1166 #endif
1167 }
1168 
1169 static const struct file_operations mtd_fops = {
1170 	.owner		= THIS_MODULE,
1171 	.llseek		= mtdchar_lseek,
1172 	.read		= mtdchar_read,
1173 	.write		= mtdchar_write,
1174 	.unlocked_ioctl	= mtdchar_unlocked_ioctl,
1175 #ifdef CONFIG_COMPAT
1176 	.compat_ioctl	= mtdchar_compat_ioctl,
1177 #endif
1178 	.open		= mtdchar_open,
1179 	.release	= mtdchar_close,
1180 	.mmap		= mtdchar_mmap,
1181 #ifndef CONFIG_MMU
1182 	.get_unmapped_area = mtdchar_get_unmapped_area,
1183 	.mmap_capabilities = mtdchar_mmap_capabilities,
1184 #endif
1185 };
1186 
1187 int __init init_mtdchar(void)
1188 {
1189 	int ret;
1190 
1191 	ret = __register_chrdev(MTD_CHAR_MAJOR, 0, 1 << MINORBITS,
1192 				   "mtd", &mtd_fops);
1193 	if (ret < 0) {
1194 		pr_err("Can't allocate major number %d for MTD\n",
1195 		       MTD_CHAR_MAJOR);
1196 		return ret;
1197 	}
1198 
1199 	return ret;
1200 }
1201 
1202 void __exit cleanup_mtdchar(void)
1203 {
1204 	__unregister_chrdev(MTD_CHAR_MAJOR, 0, 1 << MINORBITS, "mtd");
1205 }
1206 
1207 MODULE_ALIAS_CHARDEV_MAJOR(MTD_CHAR_MAJOR);
1208