fatent.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798
  1. /*
  2. * Copyright (C) 2004, OGAWA Hirofumi
  3. * Released under GPL v2.
  4. */
  5. #include <linux/blkdev.h>
  6. #include <linux/sched/signal.h>
  7. #include "fat.h"
  8. struct fatent_operations {
  9. void (*ent_blocknr)(struct super_block *, int, int *, sector_t *);
  10. void (*ent_set_ptr)(struct fat_entry *, int);
  11. int (*ent_bread)(struct super_block *, struct fat_entry *,
  12. int, sector_t);
  13. int (*ent_get)(struct fat_entry *);
  14. void (*ent_put)(struct fat_entry *, int);
  15. int (*ent_next)(struct fat_entry *);
  16. };
  17. static DEFINE_SPINLOCK(fat12_entry_lock);
  18. static void fat12_ent_blocknr(struct super_block *sb, int entry,
  19. int *offset, sector_t *blocknr)
  20. {
  21. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  22. int bytes = entry + (entry >> 1);
  23. WARN_ON(!fat_valid_entry(sbi, entry));
  24. *offset = bytes & (sb->s_blocksize - 1);
  25. *blocknr = sbi->fat_start + (bytes >> sb->s_blocksize_bits);
  26. }
  27. static void fat_ent_blocknr(struct super_block *sb, int entry,
  28. int *offset, sector_t *blocknr)
  29. {
  30. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  31. int bytes = (entry << sbi->fatent_shift);
  32. WARN_ON(!fat_valid_entry(sbi, entry));
  33. *offset = bytes & (sb->s_blocksize - 1);
  34. *blocknr = sbi->fat_start + (bytes >> sb->s_blocksize_bits);
  35. }
  36. static void fat12_ent_set_ptr(struct fat_entry *fatent, int offset)
  37. {
  38. struct buffer_head **bhs = fatent->bhs;
  39. if (fatent->nr_bhs == 1) {
  40. WARN_ON(offset >= (bhs[0]->b_size - 1));
  41. fatent->u.ent12_p[0] = bhs[0]->b_data + offset;
  42. fatent->u.ent12_p[1] = bhs[0]->b_data + (offset + 1);
  43. } else {
  44. WARN_ON(offset != (bhs[0]->b_size - 1));
  45. fatent->u.ent12_p[0] = bhs[0]->b_data + offset;
  46. fatent->u.ent12_p[1] = bhs[1]->b_data;
  47. }
  48. }
  49. static void fat16_ent_set_ptr(struct fat_entry *fatent, int offset)
  50. {
  51. WARN_ON(offset & (2 - 1));
  52. fatent->u.ent16_p = (__le16 *)(fatent->bhs[0]->b_data + offset);
  53. }
  54. static void fat32_ent_set_ptr(struct fat_entry *fatent, int offset)
  55. {
  56. WARN_ON(offset & (4 - 1));
  57. fatent->u.ent32_p = (__le32 *)(fatent->bhs[0]->b_data + offset);
  58. }
  59. static int fat12_ent_bread(struct super_block *sb, struct fat_entry *fatent,
  60. int offset, sector_t blocknr)
  61. {
  62. struct buffer_head **bhs = fatent->bhs;
  63. WARN_ON(blocknr < MSDOS_SB(sb)->fat_start);
  64. fatent->fat_inode = MSDOS_SB(sb)->fat_inode;
  65. bhs[0] = sb_bread(sb, blocknr);
  66. if (!bhs[0])
  67. goto err;
  68. if ((offset + 1) < sb->s_blocksize)
  69. fatent->nr_bhs = 1;
  70. else {
  71. /* This entry is block boundary, it needs the next block */
  72. blocknr++;
  73. bhs[1] = sb_bread(sb, blocknr);
  74. if (!bhs[1])
  75. goto err_brelse;
  76. fatent->nr_bhs = 2;
  77. }
  78. fat12_ent_set_ptr(fatent, offset);
  79. return 0;
  80. err_brelse:
  81. brelse(bhs[0]);
  82. err:
  83. fat_msg(sb, KERN_ERR, "FAT read failed (blocknr %llu)", (llu)blocknr);
  84. return -EIO;
  85. }
  86. static int fat_ent_bread(struct super_block *sb, struct fat_entry *fatent,
  87. int offset, sector_t blocknr)
  88. {
  89. const struct fatent_operations *ops = MSDOS_SB(sb)->fatent_ops;
  90. WARN_ON(blocknr < MSDOS_SB(sb)->fat_start);
  91. fatent->fat_inode = MSDOS_SB(sb)->fat_inode;
  92. fatent->bhs[0] = sb_bread(sb, blocknr);
  93. if (!fatent->bhs[0]) {
  94. fat_msg(sb, KERN_ERR, "FAT read failed (blocknr %llu)",
  95. (llu)blocknr);
  96. return -EIO;
  97. }
  98. fatent->nr_bhs = 1;
  99. ops->ent_set_ptr(fatent, offset);
  100. return 0;
  101. }
  102. static int fat12_ent_get(struct fat_entry *fatent)
  103. {
  104. u8 **ent12_p = fatent->u.ent12_p;
  105. int next;
  106. spin_lock(&fat12_entry_lock);
  107. if (fatent->entry & 1)
  108. next = (*ent12_p[0] >> 4) | (*ent12_p[1] << 4);
  109. else
  110. next = (*ent12_p[1] << 8) | *ent12_p[0];
  111. spin_unlock(&fat12_entry_lock);
  112. next &= 0x0fff;
  113. if (next >= BAD_FAT12)
  114. next = FAT_ENT_EOF;
  115. return next;
  116. }
  117. static int fat16_ent_get(struct fat_entry *fatent)
  118. {
  119. int next = le16_to_cpu(*fatent->u.ent16_p);
  120. WARN_ON((unsigned long)fatent->u.ent16_p & (2 - 1));
  121. if (next >= BAD_FAT16)
  122. next = FAT_ENT_EOF;
  123. return next;
  124. }
  125. static int fat32_ent_get(struct fat_entry *fatent)
  126. {
  127. int next = le32_to_cpu(*fatent->u.ent32_p) & 0x0fffffff;
  128. WARN_ON((unsigned long)fatent->u.ent32_p & (4 - 1));
  129. if (next >= BAD_FAT32)
  130. next = FAT_ENT_EOF;
  131. return next;
  132. }
  133. static void fat12_ent_put(struct fat_entry *fatent, int new)
  134. {
  135. u8 **ent12_p = fatent->u.ent12_p;
  136. if (new == FAT_ENT_EOF)
  137. new = EOF_FAT12;
  138. spin_lock(&fat12_entry_lock);
  139. if (fatent->entry & 1) {
  140. *ent12_p[0] = (new << 4) | (*ent12_p[0] & 0x0f);
  141. *ent12_p[1] = new >> 4;
  142. } else {
  143. *ent12_p[0] = new & 0xff;
  144. *ent12_p[1] = (*ent12_p[1] & 0xf0) | (new >> 8);
  145. }
  146. spin_unlock(&fat12_entry_lock);
  147. mark_buffer_dirty_inode(fatent->bhs[0], fatent->fat_inode);
  148. if (fatent->nr_bhs == 2)
  149. mark_buffer_dirty_inode(fatent->bhs[1], fatent->fat_inode);
  150. }
  151. static void fat16_ent_put(struct fat_entry *fatent, int new)
  152. {
  153. if (new == FAT_ENT_EOF)
  154. new = EOF_FAT16;
  155. *fatent->u.ent16_p = cpu_to_le16(new);
  156. mark_buffer_dirty_inode(fatent->bhs[0], fatent->fat_inode);
  157. }
  158. static void fat32_ent_put(struct fat_entry *fatent, int new)
  159. {
  160. WARN_ON(new & 0xf0000000);
  161. new |= le32_to_cpu(*fatent->u.ent32_p) & ~0x0fffffff;
  162. *fatent->u.ent32_p = cpu_to_le32(new);
  163. mark_buffer_dirty_inode(fatent->bhs[0], fatent->fat_inode);
  164. }
  165. static int fat12_ent_next(struct fat_entry *fatent)
  166. {
  167. u8 **ent12_p = fatent->u.ent12_p;
  168. struct buffer_head **bhs = fatent->bhs;
  169. u8 *nextp = ent12_p[1] + 1 + (fatent->entry & 1);
  170. fatent->entry++;
  171. if (fatent->nr_bhs == 1) {
  172. WARN_ON(ent12_p[0] > (u8 *)(bhs[0]->b_data +
  173. (bhs[0]->b_size - 2)));
  174. WARN_ON(ent12_p[1] > (u8 *)(bhs[0]->b_data +
  175. (bhs[0]->b_size - 1)));
  176. if (nextp < (u8 *)(bhs[0]->b_data + (bhs[0]->b_size - 1))) {
  177. ent12_p[0] = nextp - 1;
  178. ent12_p[1] = nextp;
  179. return 1;
  180. }
  181. } else {
  182. WARN_ON(ent12_p[0] != (u8 *)(bhs[0]->b_data +
  183. (bhs[0]->b_size - 1)));
  184. WARN_ON(ent12_p[1] != (u8 *)bhs[1]->b_data);
  185. ent12_p[0] = nextp - 1;
  186. ent12_p[1] = nextp;
  187. brelse(bhs[0]);
  188. bhs[0] = bhs[1];
  189. fatent->nr_bhs = 1;
  190. return 1;
  191. }
  192. ent12_p[0] = NULL;
  193. ent12_p[1] = NULL;
  194. return 0;
  195. }
  196. static int fat16_ent_next(struct fat_entry *fatent)
  197. {
  198. const struct buffer_head *bh = fatent->bhs[0];
  199. fatent->entry++;
  200. if (fatent->u.ent16_p < (__le16 *)(bh->b_data + (bh->b_size - 2))) {
  201. fatent->u.ent16_p++;
  202. return 1;
  203. }
  204. fatent->u.ent16_p = NULL;
  205. return 0;
  206. }
  207. static int fat32_ent_next(struct fat_entry *fatent)
  208. {
  209. const struct buffer_head *bh = fatent->bhs[0];
  210. fatent->entry++;
  211. if (fatent->u.ent32_p < (__le32 *)(bh->b_data + (bh->b_size - 4))) {
  212. fatent->u.ent32_p++;
  213. return 1;
  214. }
  215. fatent->u.ent32_p = NULL;
  216. return 0;
  217. }
  218. static const struct fatent_operations fat12_ops = {
  219. .ent_blocknr = fat12_ent_blocknr,
  220. .ent_set_ptr = fat12_ent_set_ptr,
  221. .ent_bread = fat12_ent_bread,
  222. .ent_get = fat12_ent_get,
  223. .ent_put = fat12_ent_put,
  224. .ent_next = fat12_ent_next,
  225. };
  226. static const struct fatent_operations fat16_ops = {
  227. .ent_blocknr = fat_ent_blocknr,
  228. .ent_set_ptr = fat16_ent_set_ptr,
  229. .ent_bread = fat_ent_bread,
  230. .ent_get = fat16_ent_get,
  231. .ent_put = fat16_ent_put,
  232. .ent_next = fat16_ent_next,
  233. };
  234. static const struct fatent_operations fat32_ops = {
  235. .ent_blocknr = fat_ent_blocknr,
  236. .ent_set_ptr = fat32_ent_set_ptr,
  237. .ent_bread = fat_ent_bread,
  238. .ent_get = fat32_ent_get,
  239. .ent_put = fat32_ent_put,
  240. .ent_next = fat32_ent_next,
  241. };
  242. static inline void lock_fat(struct msdos_sb_info *sbi)
  243. {
  244. mutex_lock(&sbi->fat_lock);
  245. }
  246. static inline void unlock_fat(struct msdos_sb_info *sbi)
  247. {
  248. mutex_unlock(&sbi->fat_lock);
  249. }
  250. void fat_ent_access_init(struct super_block *sb)
  251. {
  252. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  253. mutex_init(&sbi->fat_lock);
  254. switch (sbi->fat_bits) {
  255. case 32:
  256. sbi->fatent_shift = 2;
  257. sbi->fatent_ops = &fat32_ops;
  258. break;
  259. case 16:
  260. sbi->fatent_shift = 1;
  261. sbi->fatent_ops = &fat16_ops;
  262. break;
  263. case 12:
  264. sbi->fatent_shift = -1;
  265. sbi->fatent_ops = &fat12_ops;
  266. break;
  267. }
  268. }
  269. static void mark_fsinfo_dirty(struct super_block *sb)
  270. {
  271. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  272. if (sb_rdonly(sb) || sbi->fat_bits != 32)
  273. return;
  274. __mark_inode_dirty(sbi->fsinfo_inode, I_DIRTY_SYNC);
  275. }
  276. static inline int fat_ent_update_ptr(struct super_block *sb,
  277. struct fat_entry *fatent,
  278. int offset, sector_t blocknr)
  279. {
  280. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  281. const struct fatent_operations *ops = sbi->fatent_ops;
  282. struct buffer_head **bhs = fatent->bhs;
  283. /* Is this fatent's blocks including this entry? */
  284. if (!fatent->nr_bhs || bhs[0]->b_blocknr != blocknr)
  285. return 0;
  286. if (sbi->fat_bits == 12) {
  287. if ((offset + 1) < sb->s_blocksize) {
  288. /* This entry is on bhs[0]. */
  289. if (fatent->nr_bhs == 2) {
  290. brelse(bhs[1]);
  291. fatent->nr_bhs = 1;
  292. }
  293. } else {
  294. /* This entry needs the next block. */
  295. if (fatent->nr_bhs != 2)
  296. return 0;
  297. if (bhs[1]->b_blocknr != (blocknr + 1))
  298. return 0;
  299. }
  300. }
  301. ops->ent_set_ptr(fatent, offset);
  302. return 1;
  303. }
  304. int fat_ent_read(struct inode *inode, struct fat_entry *fatent, int entry)
  305. {
  306. struct super_block *sb = inode->i_sb;
  307. struct msdos_sb_info *sbi = MSDOS_SB(inode->i_sb);
  308. const struct fatent_operations *ops = sbi->fatent_ops;
  309. int err, offset;
  310. sector_t blocknr;
  311. if (!fat_valid_entry(sbi, entry)) {
  312. fatent_brelse(fatent);
  313. fat_fs_error(sb, "invalid access to FAT (entry 0x%08x)", entry);
  314. return -EIO;
  315. }
  316. fatent_set_entry(fatent, entry);
  317. ops->ent_blocknr(sb, entry, &offset, &blocknr);
  318. if (!fat_ent_update_ptr(sb, fatent, offset, blocknr)) {
  319. fatent_brelse(fatent);
  320. err = ops->ent_bread(sb, fatent, offset, blocknr);
  321. if (err)
  322. return err;
  323. }
  324. return ops->ent_get(fatent);
  325. }
  326. /* FIXME: We can write the blocks as more big chunk. */
  327. static int fat_mirror_bhs(struct super_block *sb, struct buffer_head **bhs,
  328. int nr_bhs)
  329. {
  330. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  331. struct buffer_head *c_bh;
  332. int err, n, copy;
  333. err = 0;
  334. for (copy = 1; copy < sbi->fats; copy++) {
  335. sector_t backup_fat = sbi->fat_length * copy;
  336. for (n = 0; n < nr_bhs; n++) {
  337. c_bh = sb_getblk(sb, backup_fat + bhs[n]->b_blocknr);
  338. if (!c_bh) {
  339. err = -ENOMEM;
  340. goto error;
  341. }
  342. /* Avoid race with userspace read via bdev */
  343. lock_buffer(c_bh);
  344. memcpy(c_bh->b_data, bhs[n]->b_data, sb->s_blocksize);
  345. set_buffer_uptodate(c_bh);
  346. unlock_buffer(c_bh);
  347. mark_buffer_dirty_inode(c_bh, sbi->fat_inode);
  348. if (sb->s_flags & SB_SYNCHRONOUS)
  349. err = sync_dirty_buffer(c_bh);
  350. brelse(c_bh);
  351. if (err)
  352. goto error;
  353. }
  354. }
  355. error:
  356. return err;
  357. }
  358. int fat_ent_write(struct inode *inode, struct fat_entry *fatent,
  359. int new, int wait)
  360. {
  361. struct super_block *sb = inode->i_sb;
  362. const struct fatent_operations *ops = MSDOS_SB(sb)->fatent_ops;
  363. int err;
  364. ops->ent_put(fatent, new);
  365. if (wait) {
  366. err = fat_sync_bhs(fatent->bhs, fatent->nr_bhs);
  367. if (err)
  368. return err;
  369. }
  370. return fat_mirror_bhs(sb, fatent->bhs, fatent->nr_bhs);
  371. }
  372. static inline int fat_ent_next(struct msdos_sb_info *sbi,
  373. struct fat_entry *fatent)
  374. {
  375. if (sbi->fatent_ops->ent_next(fatent)) {
  376. if (fatent->entry < sbi->max_cluster)
  377. return 1;
  378. }
  379. return 0;
  380. }
  381. static inline int fat_ent_read_block(struct super_block *sb,
  382. struct fat_entry *fatent)
  383. {
  384. const struct fatent_operations *ops = MSDOS_SB(sb)->fatent_ops;
  385. sector_t blocknr;
  386. int offset;
  387. fatent_brelse(fatent);
  388. ops->ent_blocknr(sb, fatent->entry, &offset, &blocknr);
  389. return ops->ent_bread(sb, fatent, offset, blocknr);
  390. }
  391. static void fat_collect_bhs(struct buffer_head **bhs, int *nr_bhs,
  392. struct fat_entry *fatent)
  393. {
  394. int n, i;
  395. for (n = 0; n < fatent->nr_bhs; n++) {
  396. for (i = 0; i < *nr_bhs; i++) {
  397. if (fatent->bhs[n] == bhs[i])
  398. break;
  399. }
  400. if (i == *nr_bhs) {
  401. get_bh(fatent->bhs[n]);
  402. bhs[i] = fatent->bhs[n];
  403. (*nr_bhs)++;
  404. }
  405. }
  406. }
  407. int fat_alloc_clusters(struct inode *inode, int *cluster, int nr_cluster)
  408. {
  409. struct super_block *sb = inode->i_sb;
  410. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  411. const struct fatent_operations *ops = sbi->fatent_ops;
  412. struct fat_entry fatent, prev_ent;
  413. struct buffer_head *bhs[MAX_BUF_PER_PAGE];
  414. int i, count, err, nr_bhs, idx_clus;
  415. BUG_ON(nr_cluster > (MAX_BUF_PER_PAGE / 2)); /* fixed limit */
  416. lock_fat(sbi);
  417. if (sbi->free_clusters != -1 && sbi->free_clus_valid &&
  418. sbi->free_clusters < nr_cluster) {
  419. unlock_fat(sbi);
  420. return -ENOSPC;
  421. }
  422. err = nr_bhs = idx_clus = 0;
  423. count = FAT_START_ENT;
  424. fatent_init(&prev_ent);
  425. fatent_init(&fatent);
  426. fatent_set_entry(&fatent, sbi->prev_free + 1);
  427. while (count < sbi->max_cluster) {
  428. if (fatent.entry >= sbi->max_cluster)
  429. fatent.entry = FAT_START_ENT;
  430. fatent_set_entry(&fatent, fatent.entry);
  431. err = fat_ent_read_block(sb, &fatent);
  432. if (err)
  433. goto out;
  434. /* Find the free entries in a block */
  435. do {
  436. if (ops->ent_get(&fatent) == FAT_ENT_FREE) {
  437. int entry = fatent.entry;
  438. /* make the cluster chain */
  439. ops->ent_put(&fatent, FAT_ENT_EOF);
  440. if (prev_ent.nr_bhs)
  441. ops->ent_put(&prev_ent, entry);
  442. fat_collect_bhs(bhs, &nr_bhs, &fatent);
  443. sbi->prev_free = entry;
  444. if (sbi->free_clusters != -1)
  445. sbi->free_clusters--;
  446. cluster[idx_clus] = entry;
  447. idx_clus++;
  448. if (idx_clus == nr_cluster)
  449. goto out;
  450. /*
  451. * fat_collect_bhs() gets ref-count of bhs,
  452. * so we can still use the prev_ent.
  453. */
  454. prev_ent = fatent;
  455. }
  456. count++;
  457. if (count == sbi->max_cluster)
  458. break;
  459. } while (fat_ent_next(sbi, &fatent));
  460. }
  461. /* Couldn't allocate the free entries */
  462. sbi->free_clusters = 0;
  463. sbi->free_clus_valid = 1;
  464. err = -ENOSPC;
  465. out:
  466. unlock_fat(sbi);
  467. mark_fsinfo_dirty(sb);
  468. fatent_brelse(&fatent);
  469. if (!err) {
  470. if (inode_needs_sync(inode))
  471. err = fat_sync_bhs(bhs, nr_bhs);
  472. if (!err)
  473. err = fat_mirror_bhs(sb, bhs, nr_bhs);
  474. }
  475. for (i = 0; i < nr_bhs; i++)
  476. brelse(bhs[i]);
  477. if (err && idx_clus)
  478. fat_free_clusters(inode, cluster[0]);
  479. return err;
  480. }
  481. int fat_free_clusters(struct inode *inode, int cluster)
  482. {
  483. struct super_block *sb = inode->i_sb;
  484. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  485. const struct fatent_operations *ops = sbi->fatent_ops;
  486. struct fat_entry fatent;
  487. struct buffer_head *bhs[MAX_BUF_PER_PAGE];
  488. int i, err, nr_bhs;
  489. int first_cl = cluster, dirty_fsinfo = 0;
  490. nr_bhs = 0;
  491. fatent_init(&fatent);
  492. lock_fat(sbi);
  493. do {
  494. cluster = fat_ent_read(inode, &fatent, cluster);
  495. if (cluster < 0) {
  496. err = cluster;
  497. goto error;
  498. } else if (cluster == FAT_ENT_FREE) {
  499. fat_fs_error(sb, "%s: deleting FAT entry beyond EOF",
  500. __func__);
  501. err = -EIO;
  502. goto error;
  503. }
  504. if (sbi->options.discard) {
  505. /*
  506. * Issue discard for the sectors we no longer
  507. * care about, batching contiguous clusters
  508. * into one request
  509. */
  510. if (cluster != fatent.entry + 1) {
  511. int nr_clus = fatent.entry - first_cl + 1;
  512. sb_issue_discard(sb,
  513. fat_clus_to_blknr(sbi, first_cl),
  514. nr_clus * sbi->sec_per_clus,
  515. GFP_NOFS, 0);
  516. first_cl = cluster;
  517. }
  518. }
  519. ops->ent_put(&fatent, FAT_ENT_FREE);
  520. if (sbi->free_clusters != -1) {
  521. sbi->free_clusters++;
  522. dirty_fsinfo = 1;
  523. }
  524. if (nr_bhs + fatent.nr_bhs > MAX_BUF_PER_PAGE) {
  525. if (sb->s_flags & SB_SYNCHRONOUS) {
  526. err = fat_sync_bhs(bhs, nr_bhs);
  527. if (err)
  528. goto error;
  529. }
  530. err = fat_mirror_bhs(sb, bhs, nr_bhs);
  531. if (err)
  532. goto error;
  533. for (i = 0; i < nr_bhs; i++)
  534. brelse(bhs[i]);
  535. nr_bhs = 0;
  536. }
  537. fat_collect_bhs(bhs, &nr_bhs, &fatent);
  538. } while (cluster != FAT_ENT_EOF);
  539. if (sb->s_flags & SB_SYNCHRONOUS) {
  540. err = fat_sync_bhs(bhs, nr_bhs);
  541. if (err)
  542. goto error;
  543. }
  544. err = fat_mirror_bhs(sb, bhs, nr_bhs);
  545. error:
  546. fatent_brelse(&fatent);
  547. for (i = 0; i < nr_bhs; i++)
  548. brelse(bhs[i]);
  549. unlock_fat(sbi);
  550. if (dirty_fsinfo)
  551. mark_fsinfo_dirty(sb);
  552. return err;
  553. }
  554. EXPORT_SYMBOL_GPL(fat_free_clusters);
  555. /* 128kb is the whole sectors for FAT12 and FAT16 */
  556. #define FAT_READA_SIZE (128 * 1024)
  557. static void fat_ent_reada(struct super_block *sb, struct fat_entry *fatent,
  558. unsigned long reada_blocks)
  559. {
  560. const struct fatent_operations *ops = MSDOS_SB(sb)->fatent_ops;
  561. sector_t blocknr;
  562. int i, offset;
  563. ops->ent_blocknr(sb, fatent->entry, &offset, &blocknr);
  564. for (i = 0; i < reada_blocks; i++)
  565. sb_breadahead(sb, blocknr + i);
  566. }
  567. int fat_count_free_clusters(struct super_block *sb)
  568. {
  569. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  570. const struct fatent_operations *ops = sbi->fatent_ops;
  571. struct fat_entry fatent;
  572. unsigned long reada_blocks, reada_mask, cur_block;
  573. int err = 0, free;
  574. lock_fat(sbi);
  575. if (sbi->free_clusters != -1 && sbi->free_clus_valid)
  576. goto out;
  577. reada_blocks = FAT_READA_SIZE >> sb->s_blocksize_bits;
  578. reada_mask = reada_blocks - 1;
  579. cur_block = 0;
  580. free = 0;
  581. fatent_init(&fatent);
  582. fatent_set_entry(&fatent, FAT_START_ENT);
  583. while (fatent.entry < sbi->max_cluster) {
  584. /* readahead of fat blocks */
  585. if ((cur_block & reada_mask) == 0) {
  586. unsigned long rest = sbi->fat_length - cur_block;
  587. fat_ent_reada(sb, &fatent, min(reada_blocks, rest));
  588. }
  589. cur_block++;
  590. err = fat_ent_read_block(sb, &fatent);
  591. if (err)
  592. goto out;
  593. do {
  594. if (ops->ent_get(&fatent) == FAT_ENT_FREE)
  595. free++;
  596. } while (fat_ent_next(sbi, &fatent));
  597. cond_resched();
  598. }
  599. sbi->free_clusters = free;
  600. sbi->free_clus_valid = 1;
  601. mark_fsinfo_dirty(sb);
  602. fatent_brelse(&fatent);
  603. out:
  604. unlock_fat(sbi);
  605. return err;
  606. }
  607. static int fat_trim_clusters(struct super_block *sb, u32 clus, u32 nr_clus)
  608. {
  609. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  610. return sb_issue_discard(sb, fat_clus_to_blknr(sbi, clus),
  611. nr_clus * sbi->sec_per_clus, GFP_NOFS, 0);
  612. }
  613. int fat_trim_fs(struct inode *inode, struct fstrim_range *range)
  614. {
  615. struct super_block *sb = inode->i_sb;
  616. struct msdos_sb_info *sbi = MSDOS_SB(sb);
  617. const struct fatent_operations *ops = sbi->fatent_ops;
  618. struct fat_entry fatent;
  619. u64 ent_start, ent_end, minlen, trimmed = 0;
  620. u32 free = 0;
  621. unsigned long reada_blocks, reada_mask, cur_block = 0;
  622. int err = 0;
  623. /*
  624. * FAT data is organized as clusters, trim at the granulary of cluster.
  625. *
  626. * fstrim_range is in byte, convert vaules to cluster index.
  627. * Treat sectors before data region as all used, not to trim them.
  628. */
  629. ent_start = max_t(u64, range->start>>sbi->cluster_bits, FAT_START_ENT);
  630. ent_end = ent_start + (range->len >> sbi->cluster_bits) - 1;
  631. minlen = range->minlen >> sbi->cluster_bits;
  632. if (ent_start >= sbi->max_cluster || range->len < sbi->cluster_size)
  633. return -EINVAL;
  634. if (ent_end >= sbi->max_cluster)
  635. ent_end = sbi->max_cluster - 1;
  636. reada_blocks = FAT_READA_SIZE >> sb->s_blocksize_bits;
  637. reada_mask = reada_blocks - 1;
  638. fatent_init(&fatent);
  639. lock_fat(sbi);
  640. fatent_set_entry(&fatent, ent_start);
  641. while (fatent.entry <= ent_end) {
  642. /* readahead of fat blocks */
  643. if ((cur_block & reada_mask) == 0) {
  644. unsigned long rest = sbi->fat_length - cur_block;
  645. fat_ent_reada(sb, &fatent, min(reada_blocks, rest));
  646. }
  647. cur_block++;
  648. err = fat_ent_read_block(sb, &fatent);
  649. if (err)
  650. goto error;
  651. do {
  652. if (ops->ent_get(&fatent) == FAT_ENT_FREE) {
  653. free++;
  654. } else if (free) {
  655. if (free >= minlen) {
  656. u32 clus = fatent.entry - free;
  657. err = fat_trim_clusters(sb, clus, free);
  658. if (err && err != -EOPNOTSUPP)
  659. goto error;
  660. if (!err)
  661. trimmed += free;
  662. err = 0;
  663. }
  664. free = 0;
  665. }
  666. } while (fat_ent_next(sbi, &fatent) && fatent.entry <= ent_end);
  667. if (fatal_signal_pending(current)) {
  668. err = -ERESTARTSYS;
  669. goto error;
  670. }
  671. if (need_resched()) {
  672. fatent_brelse(&fatent);
  673. unlock_fat(sbi);
  674. cond_resched();
  675. lock_fat(sbi);
  676. }
  677. }
  678. /* handle scenario when tail entries are all free */
  679. if (free && free >= minlen) {
  680. u32 clus = fatent.entry - free;
  681. err = fat_trim_clusters(sb, clus, free);
  682. if (err && err != -EOPNOTSUPP)
  683. goto error;
  684. if (!err)
  685. trimmed += free;
  686. err = 0;
  687. }
  688. error:
  689. fatent_brelse(&fatent);
  690. unlock_fat(sbi);
  691. range->len = trimmed << sbi->cluster_bits;
  692. return err;
  693. }