mtdchar.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983
  1. /*
  2. * Character-device access to raw MTD devices.
  3. *
  4. */
  5. #include <linux/device.h>
  6. #include <linux/fs.h>
  7. #include <linux/mm.h>
  8. #include <linux/err.h>
  9. #include <linux/init.h>
  10. #include <linux/kernel.h>
  11. #include <linux/module.h>
  12. #include <linux/slab.h>
  13. #include <linux/sched.h>
  14. #include <linux/smp_lock.h>
  15. #include <linux/backing-dev.h>
  16. #include <linux/compat.h>
  17. #include <linux/mtd/mtd.h>
  18. #include <linux/mtd/compatmac.h>
  19. #include <asm/uaccess.h>
  20. /*
  21. * Data structure to hold the pointer to the mtd device as well
  22. * as mode information ofr various use cases.
  23. */
  24. struct mtd_file_info {
  25. struct mtd_info *mtd;
  26. enum mtd_file_modes mode;
  27. };
  28. static loff_t mtd_lseek (struct file *file, loff_t offset, int orig)
  29. {
  30. struct mtd_file_info *mfi = file->private_data;
  31. struct mtd_info *mtd = mfi->mtd;
  32. switch (orig) {
  33. case SEEK_SET:
  34. break;
  35. case SEEK_CUR:
  36. offset += file->f_pos;
  37. break;
  38. case SEEK_END:
  39. offset += mtd->size;
  40. break;
  41. default:
  42. return -EINVAL;
  43. }
  44. if (offset >= 0 && offset <= mtd->size)
  45. return file->f_pos = offset;
  46. return -EINVAL;
  47. }
  48. static int mtd_open(struct inode *inode, struct file *file)
  49. {
  50. int minor = iminor(inode);
  51. int devnum = minor >> 1;
  52. int ret = 0;
  53. struct mtd_info *mtd;
  54. struct mtd_file_info *mfi;
  55. DEBUG(MTD_DEBUG_LEVEL0, "MTD_open\n");
  56. if (devnum >= MAX_MTD_DEVICES)
  57. return -ENODEV;
  58. /* You can't open the RO devices RW */
  59. if ((file->f_mode & FMODE_WRITE) && (minor & 1))
  60. return -EACCES;
  61. lock_kernel();
  62. mtd = get_mtd_device(NULL, devnum);
  63. if (IS_ERR(mtd)) {
  64. ret = PTR_ERR(mtd);
  65. goto out;
  66. }
  67. if (mtd->type == MTD_ABSENT) {
  68. put_mtd_device(mtd);
  69. ret = -ENODEV;
  70. goto out;
  71. }
  72. if (mtd->backing_dev_info)
  73. file->f_mapping->backing_dev_info = mtd->backing_dev_info;
  74. /* You can't open it RW if it's not a writeable device */
  75. if ((file->f_mode & FMODE_WRITE) && !(mtd->flags & MTD_WRITEABLE)) {
  76. put_mtd_device(mtd);
  77. ret = -EACCES;
  78. goto out;
  79. }
  80. mfi = kzalloc(sizeof(*mfi), GFP_KERNEL);
  81. if (!mfi) {
  82. put_mtd_device(mtd);
  83. ret = -ENOMEM;
  84. goto out;
  85. }
  86. mfi->mtd = mtd;
  87. file->private_data = mfi;
  88. out:
  89. unlock_kernel();
  90. return ret;
  91. } /* mtd_open */
  92. /*====================================================================*/
  93. static int mtd_close(struct inode *inode, struct file *file)
  94. {
  95. struct mtd_file_info *mfi = file->private_data;
  96. struct mtd_info *mtd = mfi->mtd;
  97. DEBUG(MTD_DEBUG_LEVEL0, "MTD_close\n");
  98. /* Only sync if opened RW */
  99. if ((file->f_mode & FMODE_WRITE) && mtd->sync)
  100. mtd->sync(mtd);
  101. put_mtd_device(mtd);
  102. file->private_data = NULL;
  103. kfree(mfi);
  104. return 0;
  105. } /* mtd_close */
  106. /* FIXME: This _really_ needs to die. In 2.5, we should lock the
  107. userspace buffer down and use it directly with readv/writev.
  108. */
  109. #define MAX_KMALLOC_SIZE 0x20000
  110. static ssize_t mtd_read(struct file *file, char __user *buf, size_t count,loff_t *ppos)
  111. {
  112. struct mtd_file_info *mfi = file->private_data;
  113. struct mtd_info *mtd = mfi->mtd;
  114. size_t retlen=0;
  115. size_t total_retlen=0;
  116. int ret=0;
  117. int len;
  118. char *kbuf;
  119. DEBUG(MTD_DEBUG_LEVEL0,"MTD_read\n");
  120. if (*ppos + count > mtd->size)
  121. count = mtd->size - *ppos;
  122. if (!count)
  123. return 0;
  124. /* FIXME: Use kiovec in 2.5 to lock down the user's buffers
  125. and pass them directly to the MTD functions */
  126. if (count > MAX_KMALLOC_SIZE)
  127. kbuf=kmalloc(MAX_KMALLOC_SIZE, GFP_KERNEL);
  128. else
  129. kbuf=kmalloc(count, GFP_KERNEL);
  130. if (!kbuf)
  131. return -ENOMEM;
  132. while (count) {
  133. if (count > MAX_KMALLOC_SIZE)
  134. len = MAX_KMALLOC_SIZE;
  135. else
  136. len = count;
  137. switch (mfi->mode) {
  138. case MTD_MODE_OTP_FACTORY:
  139. ret = mtd->read_fact_prot_reg(mtd, *ppos, len, &retlen, kbuf);
  140. break;
  141. case MTD_MODE_OTP_USER:
  142. ret = mtd->read_user_prot_reg(mtd, *ppos, len, &retlen, kbuf);
  143. break;
  144. case MTD_MODE_RAW:
  145. {
  146. struct mtd_oob_ops ops;
  147. ops.mode = MTD_OOB_RAW;
  148. ops.datbuf = kbuf;
  149. ops.oobbuf = NULL;
  150. ops.len = len;
  151. ret = mtd->read_oob(mtd, *ppos, &ops);
  152. retlen = ops.retlen;
  153. break;
  154. }
  155. default:
  156. ret = mtd->read(mtd, *ppos, len, &retlen, kbuf);
  157. }
  158. /* Nand returns -EBADMSG on ecc errors, but it returns
  159. * the data. For our userspace tools it is important
  160. * to dump areas with ecc errors !
  161. * For kernel internal usage it also might return -EUCLEAN
  162. * to signal the caller that a bitflip has occured and has
  163. * been corrected by the ECC algorithm.
  164. * Userspace software which accesses NAND this way
  165. * must be aware of the fact that it deals with NAND
  166. */
  167. if (!ret || (ret == -EUCLEAN) || (ret == -EBADMSG)) {
  168. *ppos += retlen;
  169. if (copy_to_user(buf, kbuf, retlen)) {
  170. kfree(kbuf);
  171. return -EFAULT;
  172. }
  173. else
  174. total_retlen += retlen;
  175. count -= retlen;
  176. buf += retlen;
  177. if (retlen == 0)
  178. count = 0;
  179. }
  180. else {
  181. kfree(kbuf);
  182. return ret;
  183. }
  184. }
  185. kfree(kbuf);
  186. return total_retlen;
  187. } /* mtd_read */
  188. static ssize_t mtd_write(struct file *file, const char __user *buf, size_t count,loff_t *ppos)
  189. {
  190. struct mtd_file_info *mfi = file->private_data;
  191. struct mtd_info *mtd = mfi->mtd;
  192. char *kbuf;
  193. size_t retlen;
  194. size_t total_retlen=0;
  195. int ret=0;
  196. int len;
  197. DEBUG(MTD_DEBUG_LEVEL0,"MTD_write\n");
  198. if (*ppos == mtd->size)
  199. return -ENOSPC;
  200. if (*ppos + count > mtd->size)
  201. count = mtd->size - *ppos;
  202. if (!count)
  203. return 0;
  204. if (count > MAX_KMALLOC_SIZE)
  205. kbuf=kmalloc(MAX_KMALLOC_SIZE, GFP_KERNEL);
  206. else
  207. kbuf=kmalloc(count, GFP_KERNEL);
  208. if (!kbuf)
  209. return -ENOMEM;
  210. while (count) {
  211. if (count > MAX_KMALLOC_SIZE)
  212. len = MAX_KMALLOC_SIZE;
  213. else
  214. len = count;
  215. if (copy_from_user(kbuf, buf, len)) {
  216. kfree(kbuf);
  217. return -EFAULT;
  218. }
  219. switch (mfi->mode) {
  220. case MTD_MODE_OTP_FACTORY:
  221. ret = -EROFS;
  222. break;
  223. case MTD_MODE_OTP_USER:
  224. if (!mtd->write_user_prot_reg) {
  225. ret = -EOPNOTSUPP;
  226. break;
  227. }
  228. ret = mtd->write_user_prot_reg(mtd, *ppos, len, &retlen, kbuf);
  229. break;
  230. case MTD_MODE_RAW:
  231. {
  232. struct mtd_oob_ops ops;
  233. ops.mode = MTD_OOB_RAW;
  234. ops.datbuf = kbuf;
  235. ops.oobbuf = NULL;
  236. ops.len = len;
  237. ret = mtd->write_oob(mtd, *ppos, &ops);
  238. retlen = ops.retlen;
  239. break;
  240. }
  241. default:
  242. ret = (*(mtd->write))(mtd, *ppos, len, &retlen, kbuf);
  243. }
  244. if (!ret) {
  245. *ppos += retlen;
  246. total_retlen += retlen;
  247. count -= retlen;
  248. buf += retlen;
  249. }
  250. else {
  251. kfree(kbuf);
  252. return ret;
  253. }
  254. }
  255. kfree(kbuf);
  256. return total_retlen;
  257. } /* mtd_write */
  258. /*======================================================================
  259. IOCTL calls for getting device parameters.
  260. ======================================================================*/
  261. static void mtdchar_erase_callback (struct erase_info *instr)
  262. {
  263. wake_up((wait_queue_head_t *)instr->priv);
  264. }
  265. #ifdef CONFIG_HAVE_MTD_OTP
  266. static int otp_select_filemode(struct mtd_file_info *mfi, int mode)
  267. {
  268. struct mtd_info *mtd = mfi->mtd;
  269. int ret = 0;
  270. switch (mode) {
  271. case MTD_OTP_FACTORY:
  272. if (!mtd->read_fact_prot_reg)
  273. ret = -EOPNOTSUPP;
  274. else
  275. mfi->mode = MTD_MODE_OTP_FACTORY;
  276. break;
  277. case MTD_OTP_USER:
  278. if (!mtd->read_fact_prot_reg)
  279. ret = -EOPNOTSUPP;
  280. else
  281. mfi->mode = MTD_MODE_OTP_USER;
  282. break;
  283. default:
  284. ret = -EINVAL;
  285. case MTD_OTP_OFF:
  286. break;
  287. }
  288. return ret;
  289. }
  290. #else
  291. # define otp_select_filemode(f,m) -EOPNOTSUPP
  292. #endif
  293. static int mtd_do_writeoob(struct file *file, struct mtd_info *mtd,
  294. uint64_t start, uint32_t length, void __user *ptr,
  295. uint32_t __user *retp)
  296. {
  297. struct mtd_oob_ops ops;
  298. uint32_t retlen;
  299. int ret = 0;
  300. if (!(file->f_mode & FMODE_WRITE))
  301. return -EPERM;
  302. if (length > 4096)
  303. return -EINVAL;
  304. if (!mtd->write_oob)
  305. ret = -EOPNOTSUPP;
  306. else
  307. ret = access_ok(VERIFY_READ, ptr, length) ? 0 : EFAULT;
  308. if (ret)
  309. return ret;
  310. ops.ooblen = length;
  311. ops.ooboffs = start & (mtd->oobsize - 1);
  312. ops.datbuf = NULL;
  313. ops.mode = MTD_OOB_PLACE;
  314. if (ops.ooboffs && ops.ooblen > (mtd->oobsize - ops.ooboffs))
  315. return -EINVAL;
  316. ops.oobbuf = kmalloc(length, GFP_KERNEL);
  317. if (!ops.oobbuf)
  318. return -ENOMEM;
  319. if (copy_from_user(ops.oobbuf, ptr, length)) {
  320. kfree(ops.oobbuf);
  321. return -EFAULT;
  322. }
  323. start &= ~((uint64_t)mtd->oobsize - 1);
  324. ret = mtd->write_oob(mtd, start, &ops);
  325. if (ops.oobretlen > 0xFFFFFFFFU)
  326. ret = -EOVERFLOW;
  327. retlen = ops.oobretlen;
  328. if (copy_to_user(retp, &retlen, sizeof(length)))
  329. ret = -EFAULT;
  330. kfree(ops.oobbuf);
  331. return ret;
  332. }
  333. static int mtd_do_readoob(struct mtd_info *mtd, uint64_t start,
  334. uint32_t length, void __user *ptr, uint32_t __user *retp)
  335. {
  336. struct mtd_oob_ops ops;
  337. int ret = 0;
  338. if (length > 4096)
  339. return -EINVAL;
  340. if (!mtd->read_oob)
  341. ret = -EOPNOTSUPP;
  342. else
  343. ret = access_ok(VERIFY_WRITE, ptr,
  344. length) ? 0 : -EFAULT;
  345. if (ret)
  346. return ret;
  347. ops.ooblen = length;
  348. ops.ooboffs = start & (mtd->oobsize - 1);
  349. ops.datbuf = NULL;
  350. ops.mode = MTD_OOB_PLACE;
  351. if (ops.ooboffs && ops.ooblen > (mtd->oobsize - ops.ooboffs))
  352. return -EINVAL;
  353. ops.oobbuf = kmalloc(length, GFP_KERNEL);
  354. if (!ops.oobbuf)
  355. return -ENOMEM;
  356. start &= ~((uint64_t)mtd->oobsize - 1);
  357. ret = mtd->read_oob(mtd, start, &ops);
  358. if (put_user(ops.oobretlen, retp))
  359. ret = -EFAULT;
  360. else if (ops.oobretlen && copy_to_user(ptr, ops.oobbuf,
  361. ops.oobretlen))
  362. ret = -EFAULT;
  363. kfree(ops.oobbuf);
  364. return ret;
  365. }
  366. static int mtd_ioctl(struct inode *inode, struct file *file,
  367. u_int cmd, u_long arg)
  368. {
  369. struct mtd_file_info *mfi = file->private_data;
  370. struct mtd_info *mtd = mfi->mtd;
  371. void __user *argp = (void __user *)arg;
  372. int ret = 0;
  373. u_long size;
  374. struct mtd_info_user info;
  375. DEBUG(MTD_DEBUG_LEVEL0, "MTD_ioctl\n");
  376. size = (cmd & IOCSIZE_MASK) >> IOCSIZE_SHIFT;
  377. if (cmd & IOC_IN) {
  378. if (!access_ok(VERIFY_READ, argp, size))
  379. return -EFAULT;
  380. }
  381. if (cmd & IOC_OUT) {
  382. if (!access_ok(VERIFY_WRITE, argp, size))
  383. return -EFAULT;
  384. }
  385. switch (cmd) {
  386. case MEMGETREGIONCOUNT:
  387. if (copy_to_user(argp, &(mtd->numeraseregions), sizeof(int)))
  388. return -EFAULT;
  389. break;
  390. case MEMGETREGIONINFO:
  391. {
  392. uint32_t ur_idx;
  393. struct mtd_erase_region_info *kr;
  394. struct region_info_user *ur = (struct region_info_user *) argp;
  395. if (get_user(ur_idx, &(ur->regionindex)))
  396. return -EFAULT;
  397. kr = &(mtd->eraseregions[ur_idx]);
  398. if (put_user(kr->offset, &(ur->offset))
  399. || put_user(kr->erasesize, &(ur->erasesize))
  400. || put_user(kr->numblocks, &(ur->numblocks)))
  401. return -EFAULT;
  402. break;
  403. }
  404. case MEMGETINFO:
  405. info.type = mtd->type;
  406. info.flags = mtd->flags;
  407. info.size = mtd->size;
  408. info.erasesize = mtd->erasesize;
  409. info.writesize = mtd->writesize;
  410. info.oobsize = mtd->oobsize;
  411. /* The below fields are obsolete */
  412. info.ecctype = -1;
  413. info.eccsize = 0;
  414. if (copy_to_user(argp, &info, sizeof(struct mtd_info_user)))
  415. return -EFAULT;
  416. break;
  417. case MEMERASE:
  418. case MEMERASE64:
  419. {
  420. struct erase_info *erase;
  421. if(!(file->f_mode & FMODE_WRITE))
  422. return -EPERM;
  423. erase=kzalloc(sizeof(struct erase_info),GFP_KERNEL);
  424. if (!erase)
  425. ret = -ENOMEM;
  426. else {
  427. wait_queue_head_t waitq;
  428. DECLARE_WAITQUEUE(wait, current);
  429. init_waitqueue_head(&waitq);
  430. if (cmd == MEMERASE64) {
  431. struct erase_info_user64 einfo64;
  432. if (copy_from_user(&einfo64, argp,
  433. sizeof(struct erase_info_user64))) {
  434. kfree(erase);
  435. return -EFAULT;
  436. }
  437. erase->addr = einfo64.start;
  438. erase->len = einfo64.length;
  439. } else {
  440. struct erase_info_user einfo32;
  441. if (copy_from_user(&einfo32, argp,
  442. sizeof(struct erase_info_user))) {
  443. kfree(erase);
  444. return -EFAULT;
  445. }
  446. erase->addr = einfo32.start;
  447. erase->len = einfo32.length;
  448. }
  449. erase->mtd = mtd;
  450. erase->callback = mtdchar_erase_callback;
  451. erase->priv = (unsigned long)&waitq;
  452. /*
  453. FIXME: Allow INTERRUPTIBLE. Which means
  454. not having the wait_queue head on the stack.
  455. If the wq_head is on the stack, and we
  456. leave because we got interrupted, then the
  457. wq_head is no longer there when the
  458. callback routine tries to wake us up.
  459. */
  460. ret = mtd->erase(mtd, erase);
  461. if (!ret) {
  462. set_current_state(TASK_UNINTERRUPTIBLE);
  463. add_wait_queue(&waitq, &wait);
  464. if (erase->state != MTD_ERASE_DONE &&
  465. erase->state != MTD_ERASE_FAILED)
  466. schedule();
  467. remove_wait_queue(&waitq, &wait);
  468. set_current_state(TASK_RUNNING);
  469. ret = (erase->state == MTD_ERASE_FAILED)?-EIO:0;
  470. }
  471. kfree(erase);
  472. }
  473. break;
  474. }
  475. case MEMWRITEOOB:
  476. {
  477. struct mtd_oob_buf buf;
  478. struct mtd_oob_buf __user *buf_user = argp;
  479. /* NOTE: writes return length to buf_user->length */
  480. if (copy_from_user(&buf, argp, sizeof(buf)))
  481. ret = -EFAULT;
  482. else
  483. ret = mtd_do_writeoob(file, mtd, buf.start, buf.length,
  484. buf.ptr, &buf_user->length);
  485. break;
  486. }
  487. case MEMREADOOB:
  488. {
  489. struct mtd_oob_buf buf;
  490. struct mtd_oob_buf __user *buf_user = argp;
  491. /* NOTE: writes return length to buf_user->start */
  492. if (copy_from_user(&buf, argp, sizeof(buf)))
  493. ret = -EFAULT;
  494. else
  495. ret = mtd_do_readoob(mtd, buf.start, buf.length,
  496. buf.ptr, &buf_user->start);
  497. break;
  498. }
  499. case MEMWRITEOOB64:
  500. {
  501. struct mtd_oob_buf64 buf;
  502. struct mtd_oob_buf64 __user *buf_user = argp;
  503. if (copy_from_user(&buf, argp, sizeof(buf)))
  504. ret = -EFAULT;
  505. else
  506. ret = mtd_do_writeoob(file, mtd, buf.start, buf.length,
  507. (void __user *)(uintptr_t)buf.usr_ptr,
  508. &buf_user->length);
  509. break;
  510. }
  511. case MEMREADOOB64:
  512. {
  513. struct mtd_oob_buf64 buf;
  514. struct mtd_oob_buf64 __user *buf_user = argp;
  515. if (copy_from_user(&buf, argp, sizeof(buf)))
  516. ret = -EFAULT;
  517. else
  518. ret = mtd_do_readoob(mtd, buf.start, buf.length,
  519. (void __user *)(uintptr_t)buf.usr_ptr,
  520. &buf_user->length);
  521. break;
  522. }
  523. case MEMLOCK:
  524. {
  525. struct erase_info_user einfo;
  526. if (copy_from_user(&einfo, argp, sizeof(einfo)))
  527. return -EFAULT;
  528. if (!mtd->lock)
  529. ret = -EOPNOTSUPP;
  530. else
  531. ret = mtd->lock(mtd, einfo.start, einfo.length);
  532. break;
  533. }
  534. case MEMUNLOCK:
  535. {
  536. struct erase_info_user einfo;
  537. if (copy_from_user(&einfo, argp, sizeof(einfo)))
  538. return -EFAULT;
  539. if (!mtd->unlock)
  540. ret = -EOPNOTSUPP;
  541. else
  542. ret = mtd->unlock(mtd, einfo.start, einfo.length);
  543. break;
  544. }
  545. /* Legacy interface */
  546. case MEMGETOOBSEL:
  547. {
  548. struct nand_oobinfo oi;
  549. if (!mtd->ecclayout)
  550. return -EOPNOTSUPP;
  551. if (mtd->ecclayout->eccbytes > ARRAY_SIZE(oi.eccpos))
  552. return -EINVAL;
  553. oi.useecc = MTD_NANDECC_AUTOPLACE;
  554. memcpy(&oi.eccpos, mtd->ecclayout->eccpos, sizeof(oi.eccpos));
  555. memcpy(&oi.oobfree, mtd->ecclayout->oobfree,
  556. sizeof(oi.oobfree));
  557. oi.eccbytes = mtd->ecclayout->eccbytes;
  558. if (copy_to_user(argp, &oi, sizeof(struct nand_oobinfo)))
  559. return -EFAULT;
  560. break;
  561. }
  562. case MEMGETBADBLOCK:
  563. {
  564. loff_t offs;
  565. if (copy_from_user(&offs, argp, sizeof(loff_t)))
  566. return -EFAULT;
  567. if (!mtd->block_isbad)
  568. ret = -EOPNOTSUPP;
  569. else
  570. return mtd->block_isbad(mtd, offs);
  571. break;
  572. }
  573. case MEMSETBADBLOCK:
  574. {
  575. loff_t offs;
  576. if (copy_from_user(&offs, argp, sizeof(loff_t)))
  577. return -EFAULT;
  578. if (!mtd->block_markbad)
  579. ret = -EOPNOTSUPP;
  580. else
  581. return mtd->block_markbad(mtd, offs);
  582. break;
  583. }
  584. #ifdef CONFIG_HAVE_MTD_OTP
  585. case OTPSELECT:
  586. {
  587. int mode;
  588. if (copy_from_user(&mode, argp, sizeof(int)))
  589. return -EFAULT;
  590. mfi->mode = MTD_MODE_NORMAL;
  591. ret = otp_select_filemode(mfi, mode);
  592. file->f_pos = 0;
  593. break;
  594. }
  595. case OTPGETREGIONCOUNT:
  596. case OTPGETREGIONINFO:
  597. {
  598. struct otp_info *buf = kmalloc(4096, GFP_KERNEL);
  599. if (!buf)
  600. return -ENOMEM;
  601. ret = -EOPNOTSUPP;
  602. switch (mfi->mode) {
  603. case MTD_MODE_OTP_FACTORY:
  604. if (mtd->get_fact_prot_info)
  605. ret = mtd->get_fact_prot_info(mtd, buf, 4096);
  606. break;
  607. case MTD_MODE_OTP_USER:
  608. if (mtd->get_user_prot_info)
  609. ret = mtd->get_user_prot_info(mtd, buf, 4096);
  610. break;
  611. default:
  612. break;
  613. }
  614. if (ret >= 0) {
  615. if (cmd == OTPGETREGIONCOUNT) {
  616. int nbr = ret / sizeof(struct otp_info);
  617. ret = copy_to_user(argp, &nbr, sizeof(int));
  618. } else
  619. ret = copy_to_user(argp, buf, ret);
  620. if (ret)
  621. ret = -EFAULT;
  622. }
  623. kfree(buf);
  624. break;
  625. }
  626. case OTPLOCK:
  627. {
  628. struct otp_info oinfo;
  629. if (mfi->mode != MTD_MODE_OTP_USER)
  630. return -EINVAL;
  631. if (copy_from_user(&oinfo, argp, sizeof(oinfo)))
  632. return -EFAULT;
  633. if (!mtd->lock_user_prot_reg)
  634. return -EOPNOTSUPP;
  635. ret = mtd->lock_user_prot_reg(mtd, oinfo.start, oinfo.length);
  636. break;
  637. }
  638. #endif
  639. case ECCGETLAYOUT:
  640. {
  641. if (!mtd->ecclayout)
  642. return -EOPNOTSUPP;
  643. if (copy_to_user(argp, mtd->ecclayout,
  644. sizeof(struct nand_ecclayout)))
  645. return -EFAULT;
  646. break;
  647. }
  648. case ECCGETSTATS:
  649. {
  650. if (copy_to_user(argp, &mtd->ecc_stats,
  651. sizeof(struct mtd_ecc_stats)))
  652. return -EFAULT;
  653. break;
  654. }
  655. case MTDFILEMODE:
  656. {
  657. mfi->mode = 0;
  658. switch(arg) {
  659. case MTD_MODE_OTP_FACTORY:
  660. case MTD_MODE_OTP_USER:
  661. ret = otp_select_filemode(mfi, arg);
  662. break;
  663. case MTD_MODE_RAW:
  664. if (!mtd->read_oob || !mtd->write_oob)
  665. return -EOPNOTSUPP;
  666. mfi->mode = arg;
  667. case MTD_MODE_NORMAL:
  668. break;
  669. default:
  670. ret = -EINVAL;
  671. }
  672. file->f_pos = 0;
  673. break;
  674. }
  675. default:
  676. ret = -ENOTTY;
  677. }
  678. return ret;
  679. } /* memory_ioctl */
  680. #ifdef CONFIG_COMPAT
  681. struct mtd_oob_buf32 {
  682. u_int32_t start;
  683. u_int32_t length;
  684. compat_caddr_t ptr; /* unsigned char* */
  685. };
  686. #define MEMWRITEOOB32 _IOWR('M', 3, struct mtd_oob_buf32)
  687. #define MEMREADOOB32 _IOWR('M', 4, struct mtd_oob_buf32)
  688. static long mtd_compat_ioctl(struct file *file, unsigned int cmd,
  689. unsigned long arg)
  690. {
  691. struct inode *inode = file->f_path.dentry->d_inode;
  692. struct mtd_file_info *mfi = file->private_data;
  693. struct mtd_info *mtd = mfi->mtd;
  694. void __user *argp = compat_ptr(arg);
  695. int ret = 0;
  696. lock_kernel();
  697. switch (cmd) {
  698. case MEMWRITEOOB32:
  699. {
  700. struct mtd_oob_buf32 buf;
  701. struct mtd_oob_buf32 __user *buf_user = argp;
  702. if (copy_from_user(&buf, argp, sizeof(buf)))
  703. ret = -EFAULT;
  704. else
  705. ret = mtd_do_writeoob(file, mtd, buf.start,
  706. buf.length, compat_ptr(buf.ptr),
  707. &buf_user->length);
  708. break;
  709. }
  710. case MEMREADOOB32:
  711. {
  712. struct mtd_oob_buf32 buf;
  713. struct mtd_oob_buf32 __user *buf_user = argp;
  714. /* NOTE: writes return length to buf->start */
  715. if (copy_from_user(&buf, argp, sizeof(buf)))
  716. ret = -EFAULT;
  717. else
  718. ret = mtd_do_readoob(mtd, buf.start,
  719. buf.length, compat_ptr(buf.ptr),
  720. &buf_user->start);
  721. break;
  722. }
  723. default:
  724. ret = mtd_ioctl(inode, file, cmd, (unsigned long)argp);
  725. }
  726. unlock_kernel();
  727. return ret;
  728. }
  729. #endif /* CONFIG_COMPAT */
  730. /*
  731. * try to determine where a shared mapping can be made
  732. * - only supported for NOMMU at the moment (MMU can't doesn't copy private
  733. * mappings)
  734. */
  735. #ifndef CONFIG_MMU
  736. static unsigned long mtd_get_unmapped_area(struct file *file,
  737. unsigned long addr,
  738. unsigned long len,
  739. unsigned long pgoff,
  740. unsigned long flags)
  741. {
  742. struct mtd_file_info *mfi = file->private_data;
  743. struct mtd_info *mtd = mfi->mtd;
  744. if (mtd->get_unmapped_area) {
  745. unsigned long offset;
  746. if (addr != 0)
  747. return (unsigned long) -EINVAL;
  748. if (len > mtd->size || pgoff >= (mtd->size >> PAGE_SHIFT))
  749. return (unsigned long) -EINVAL;
  750. offset = pgoff << PAGE_SHIFT;
  751. if (offset > mtd->size - len)
  752. return (unsigned long) -EINVAL;
  753. return mtd->get_unmapped_area(mtd, len, offset, flags);
  754. }
  755. /* can't map directly */
  756. return (unsigned long) -ENOSYS;
  757. }
  758. #endif
  759. /*
  760. * set up a mapping for shared memory segments
  761. */
  762. static int mtd_mmap(struct file *file, struct vm_area_struct *vma)
  763. {
  764. #ifdef CONFIG_MMU
  765. struct mtd_file_info *mfi = file->private_data;
  766. struct mtd_info *mtd = mfi->mtd;
  767. if (mtd->type == MTD_RAM || mtd->type == MTD_ROM)
  768. return 0;
  769. return -ENOSYS;
  770. #else
  771. return vma->vm_flags & VM_SHARED ? 0 : -ENOSYS;
  772. #endif
  773. }
  774. static const struct file_operations mtd_fops = {
  775. .owner = THIS_MODULE,
  776. .llseek = mtd_lseek,
  777. .read = mtd_read,
  778. .write = mtd_write,
  779. .ioctl = mtd_ioctl,
  780. #ifdef CONFIG_COMPAT
  781. .compat_ioctl = mtd_compat_ioctl,
  782. #endif
  783. .open = mtd_open,
  784. .release = mtd_close,
  785. .mmap = mtd_mmap,
  786. #ifndef CONFIG_MMU
  787. .get_unmapped_area = mtd_get_unmapped_area,
  788. #endif
  789. };
  790. static int __init init_mtdchar(void)
  791. {
  792. int status;
  793. status = register_chrdev(MTD_CHAR_MAJOR, "mtd", &mtd_fops);
  794. if (status < 0) {
  795. printk(KERN_NOTICE "Can't allocate major number %d for Memory Technology Devices.\n",
  796. MTD_CHAR_MAJOR);
  797. }
  798. return status;
  799. }
  800. static void __exit cleanup_mtdchar(void)
  801. {
  802. unregister_chrdev(MTD_CHAR_MAJOR, "mtd");
  803. }
  804. module_init(init_mtdchar);
  805. module_exit(cleanup_mtdchar);
  806. MODULE_ALIAS_CHARDEV_MAJOR(MTD_CHAR_MAJOR);
  807. MODULE_LICENSE("GPL");
  808. MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
  809. MODULE_DESCRIPTION("Direct character-device access to MTD devices");
  810. MODULE_ALIAS_CHARDEV_MAJOR(MTD_CHAR_MAJOR);