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