ext4_write.c 26 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012
  1. /*
  2. * (C) Copyright 2011 - 2012 Samsung Electronics
  3. * EXT4 filesystem implementation in Uboot by
  4. * Uma Shankar <uma.shankar@samsung.com>
  5. * Manjunatha C Achar <a.manjunatha@samsung.com>
  6. *
  7. * ext4ls and ext4load : Based on ext2 ls and load support in Uboot.
  8. * Ext4 read optimization taken from Open-Moko
  9. * Qi bootloader
  10. *
  11. * (C) Copyright 2004
  12. * esd gmbh <www.esd-electronics.com>
  13. * Reinhard Arlt <reinhard.arlt@esd-electronics.com>
  14. *
  15. * based on code from grub2 fs/ext2.c and fs/fshelp.c by
  16. * GRUB -- GRand Unified Bootloader
  17. * Copyright (C) 2003, 2004 Free Software Foundation, Inc.
  18. *
  19. * ext4write : Based on generic ext4 protocol.
  20. *
  21. * SPDX-License-Identifier: GPL-2.0+
  22. */
  23. #include <common.h>
  24. #include <linux/stat.h>
  25. #include <div64.h>
  26. #include "ext4_common.h"
  27. static void ext4fs_update(void)
  28. {
  29. short i;
  30. ext4fs_update_journal();
  31. struct ext_filesystem *fs = get_fs();
  32. /* update super block */
  33. put_ext4((uint64_t)(SUPERBLOCK_SIZE),
  34. (struct ext2_sblock *)fs->sb, (uint32_t)SUPERBLOCK_SIZE);
  35. /* update block groups */
  36. for (i = 0; i < fs->no_blkgrp; i++) {
  37. fs->bgd[i].bg_checksum = ext4fs_checksum_update(i);
  38. put_ext4((uint64_t)((uint64_t)fs->bgd[i].block_id * (uint64_t)fs->blksz),
  39. fs->blk_bmaps[i], fs->blksz);
  40. }
  41. /* update inode table groups */
  42. for (i = 0; i < fs->no_blkgrp; i++) {
  43. put_ext4((uint64_t) ((uint64_t)fs->bgd[i].inode_id * (uint64_t)fs->blksz),
  44. fs->inode_bmaps[i], fs->blksz);
  45. }
  46. /* update the block group descriptor table */
  47. put_ext4((uint64_t)((uint64_t)fs->gdtable_blkno * (uint64_t)fs->blksz),
  48. (struct ext2_block_group *)fs->gdtable,
  49. (fs->blksz * fs->no_blk_pergdt));
  50. ext4fs_dump_metadata();
  51. gindex = 0;
  52. gd_index = 0;
  53. }
  54. int ext4fs_get_bgdtable(void)
  55. {
  56. int status;
  57. int grp_desc_size;
  58. struct ext_filesystem *fs = get_fs();
  59. grp_desc_size = sizeof(struct ext2_block_group);
  60. fs->no_blk_pergdt = (fs->no_blkgrp * grp_desc_size) / fs->blksz;
  61. if ((fs->no_blkgrp * grp_desc_size) % fs->blksz)
  62. fs->no_blk_pergdt++;
  63. /* allocate memory for gdtable */
  64. fs->gdtable = zalloc(fs->blksz * fs->no_blk_pergdt);
  65. if (!fs->gdtable)
  66. return -ENOMEM;
  67. /* read the group descriptor table */
  68. status = ext4fs_devread((lbaint_t)fs->gdtable_blkno * fs->sect_perblk,
  69. 0, fs->blksz * fs->no_blk_pergdt, fs->gdtable);
  70. if (status == 0)
  71. goto fail;
  72. if (ext4fs_log_gdt(fs->gdtable)) {
  73. printf("Error in ext4fs_log_gdt\n");
  74. return -1;
  75. }
  76. return 0;
  77. fail:
  78. free(fs->gdtable);
  79. fs->gdtable = NULL;
  80. return -1;
  81. }
  82. static void delete_single_indirect_block(struct ext2_inode *inode)
  83. {
  84. struct ext2_block_group *bgd = NULL;
  85. static int prev_bg_bmap_idx = -1;
  86. long int blknr;
  87. int remainder;
  88. int bg_idx;
  89. int status;
  90. unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group;
  91. struct ext_filesystem *fs = get_fs();
  92. char *journal_buffer = zalloc(fs->blksz);
  93. if (!journal_buffer) {
  94. printf("No memory\n");
  95. return;
  96. }
  97. /* get block group descriptor table */
  98. bgd = (struct ext2_block_group *)fs->gdtable;
  99. /* deleting the single indirect block associated with inode */
  100. if (inode->b.blocks.indir_block != 0) {
  101. debug("SIPB releasing %u\n", inode->b.blocks.indir_block);
  102. blknr = inode->b.blocks.indir_block;
  103. bg_idx = blknr / blk_per_grp;
  104. if (fs->blksz == 1024) {
  105. remainder = blknr % blk_per_grp;
  106. if (!remainder)
  107. bg_idx--;
  108. }
  109. ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx);
  110. bgd[bg_idx].free_blocks++;
  111. fs->sb->free_blocks++;
  112. /* journal backup */
  113. if (prev_bg_bmap_idx != bg_idx) {
  114. status =
  115. ext4fs_devread((lbaint_t)bgd[bg_idx].block_id *
  116. fs->sect_perblk, 0, fs->blksz,
  117. journal_buffer);
  118. if (status == 0)
  119. goto fail;
  120. if (ext4fs_log_journal
  121. (journal_buffer, bgd[bg_idx].block_id))
  122. goto fail;
  123. prev_bg_bmap_idx = bg_idx;
  124. }
  125. }
  126. fail:
  127. free(journal_buffer);
  128. }
  129. static void delete_double_indirect_block(struct ext2_inode *inode)
  130. {
  131. int i;
  132. short status;
  133. static int prev_bg_bmap_idx = -1;
  134. long int blknr;
  135. int remainder;
  136. int bg_idx;
  137. unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group;
  138. unsigned int *di_buffer = NULL;
  139. unsigned int *DIB_start_addr = NULL;
  140. struct ext2_block_group *bgd = NULL;
  141. struct ext_filesystem *fs = get_fs();
  142. char *journal_buffer = zalloc(fs->blksz);
  143. if (!journal_buffer) {
  144. printf("No memory\n");
  145. return;
  146. }
  147. /* get the block group descriptor table */
  148. bgd = (struct ext2_block_group *)fs->gdtable;
  149. if (inode->b.blocks.double_indir_block != 0) {
  150. di_buffer = zalloc(fs->blksz);
  151. if (!di_buffer) {
  152. printf("No memory\n");
  153. return;
  154. }
  155. DIB_start_addr = (unsigned int *)di_buffer;
  156. blknr = inode->b.blocks.double_indir_block;
  157. status = ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0,
  158. fs->blksz, (char *)di_buffer);
  159. for (i = 0; i < fs->blksz / sizeof(int); i++) {
  160. if (*di_buffer == 0)
  161. break;
  162. debug("DICB releasing %u\n", *di_buffer);
  163. bg_idx = *di_buffer / blk_per_grp;
  164. if (fs->blksz == 1024) {
  165. remainder = *di_buffer % blk_per_grp;
  166. if (!remainder)
  167. bg_idx--;
  168. }
  169. ext4fs_reset_block_bmap(*di_buffer,
  170. fs->blk_bmaps[bg_idx], bg_idx);
  171. di_buffer++;
  172. bgd[bg_idx].free_blocks++;
  173. fs->sb->free_blocks++;
  174. /* journal backup */
  175. if (prev_bg_bmap_idx != bg_idx) {
  176. status = ext4fs_devread((lbaint_t)
  177. bgd[bg_idx].block_id
  178. * fs->sect_perblk, 0,
  179. fs->blksz,
  180. journal_buffer);
  181. if (status == 0)
  182. goto fail;
  183. if (ext4fs_log_journal(journal_buffer,
  184. bgd[bg_idx].block_id))
  185. goto fail;
  186. prev_bg_bmap_idx = bg_idx;
  187. }
  188. }
  189. /* removing the parent double indirect block */
  190. blknr = inode->b.blocks.double_indir_block;
  191. bg_idx = blknr / blk_per_grp;
  192. if (fs->blksz == 1024) {
  193. remainder = blknr % blk_per_grp;
  194. if (!remainder)
  195. bg_idx--;
  196. }
  197. ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx);
  198. bgd[bg_idx].free_blocks++;
  199. fs->sb->free_blocks++;
  200. /* journal backup */
  201. if (prev_bg_bmap_idx != bg_idx) {
  202. memset(journal_buffer, '\0', fs->blksz);
  203. status = ext4fs_devread((lbaint_t)bgd[bg_idx].block_id *
  204. fs->sect_perblk, 0, fs->blksz,
  205. journal_buffer);
  206. if (status == 0)
  207. goto fail;
  208. if (ext4fs_log_journal(journal_buffer,
  209. bgd[bg_idx].block_id))
  210. goto fail;
  211. prev_bg_bmap_idx = bg_idx;
  212. }
  213. debug("DIPB releasing %ld\n", blknr);
  214. }
  215. fail:
  216. free(DIB_start_addr);
  217. free(journal_buffer);
  218. }
  219. static void delete_triple_indirect_block(struct ext2_inode *inode)
  220. {
  221. int i, j;
  222. short status;
  223. static int prev_bg_bmap_idx = -1;
  224. long int blknr;
  225. int remainder;
  226. int bg_idx;
  227. unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group;
  228. unsigned int *tigp_buffer = NULL;
  229. unsigned int *tib_start_addr = NULL;
  230. unsigned int *tip_buffer = NULL;
  231. unsigned int *tipb_start_addr = NULL;
  232. struct ext2_block_group *bgd = NULL;
  233. struct ext_filesystem *fs = get_fs();
  234. char *journal_buffer = zalloc(fs->blksz);
  235. if (!journal_buffer) {
  236. printf("No memory\n");
  237. return;
  238. }
  239. /* get block group descriptor table */
  240. bgd = (struct ext2_block_group *)fs->gdtable;
  241. if (inode->b.blocks.triple_indir_block != 0) {
  242. tigp_buffer = zalloc(fs->blksz);
  243. if (!tigp_buffer) {
  244. printf("No memory\n");
  245. return;
  246. }
  247. tib_start_addr = (unsigned int *)tigp_buffer;
  248. blknr = inode->b.blocks.triple_indir_block;
  249. status = ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0,
  250. fs->blksz, (char *)tigp_buffer);
  251. for (i = 0; i < fs->blksz / sizeof(int); i++) {
  252. if (*tigp_buffer == 0)
  253. break;
  254. debug("tigp buffer releasing %u\n", *tigp_buffer);
  255. tip_buffer = zalloc(fs->blksz);
  256. if (!tip_buffer)
  257. goto fail;
  258. tipb_start_addr = (unsigned int *)tip_buffer;
  259. status = ext4fs_devread((lbaint_t)(*tigp_buffer) *
  260. fs->sect_perblk, 0, fs->blksz,
  261. (char *)tip_buffer);
  262. for (j = 0; j < fs->blksz / sizeof(int); j++) {
  263. if (*tip_buffer == 0)
  264. break;
  265. bg_idx = *tip_buffer / blk_per_grp;
  266. if (fs->blksz == 1024) {
  267. remainder = *tip_buffer % blk_per_grp;
  268. if (!remainder)
  269. bg_idx--;
  270. }
  271. ext4fs_reset_block_bmap(*tip_buffer,
  272. fs->blk_bmaps[bg_idx],
  273. bg_idx);
  274. tip_buffer++;
  275. bgd[bg_idx].free_blocks++;
  276. fs->sb->free_blocks++;
  277. /* journal backup */
  278. if (prev_bg_bmap_idx != bg_idx) {
  279. status =
  280. ext4fs_devread(
  281. (lbaint_t)
  282. bgd[bg_idx].block_id *
  283. fs->sect_perblk, 0,
  284. fs->blksz,
  285. journal_buffer);
  286. if (status == 0)
  287. goto fail;
  288. if (ext4fs_log_journal(journal_buffer,
  289. bgd[bg_idx].
  290. block_id))
  291. goto fail;
  292. prev_bg_bmap_idx = bg_idx;
  293. }
  294. }
  295. free(tipb_start_addr);
  296. tipb_start_addr = NULL;
  297. /*
  298. * removing the grand parent blocks
  299. * which is connected to inode
  300. */
  301. bg_idx = *tigp_buffer / blk_per_grp;
  302. if (fs->blksz == 1024) {
  303. remainder = *tigp_buffer % blk_per_grp;
  304. if (!remainder)
  305. bg_idx--;
  306. }
  307. ext4fs_reset_block_bmap(*tigp_buffer,
  308. fs->blk_bmaps[bg_idx], bg_idx);
  309. tigp_buffer++;
  310. bgd[bg_idx].free_blocks++;
  311. fs->sb->free_blocks++;
  312. /* journal backup */
  313. if (prev_bg_bmap_idx != bg_idx) {
  314. memset(journal_buffer, '\0', fs->blksz);
  315. status =
  316. ext4fs_devread((lbaint_t)
  317. bgd[bg_idx].block_id *
  318. fs->sect_perblk, 0,
  319. fs->blksz, journal_buffer);
  320. if (status == 0)
  321. goto fail;
  322. if (ext4fs_log_journal(journal_buffer,
  323. bgd[bg_idx].block_id))
  324. goto fail;
  325. prev_bg_bmap_idx = bg_idx;
  326. }
  327. }
  328. /* removing the grand parent triple indirect block */
  329. blknr = inode->b.blocks.triple_indir_block;
  330. bg_idx = blknr / blk_per_grp;
  331. if (fs->blksz == 1024) {
  332. remainder = blknr % blk_per_grp;
  333. if (!remainder)
  334. bg_idx--;
  335. }
  336. ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx);
  337. bgd[bg_idx].free_blocks++;
  338. fs->sb->free_blocks++;
  339. /* journal backup */
  340. if (prev_bg_bmap_idx != bg_idx) {
  341. memset(journal_buffer, '\0', fs->blksz);
  342. status = ext4fs_devread((lbaint_t)bgd[bg_idx].block_id *
  343. fs->sect_perblk, 0, fs->blksz,
  344. journal_buffer);
  345. if (status == 0)
  346. goto fail;
  347. if (ext4fs_log_journal(journal_buffer,
  348. bgd[bg_idx].block_id))
  349. goto fail;
  350. prev_bg_bmap_idx = bg_idx;
  351. }
  352. debug("tigp buffer itself releasing %ld\n", blknr);
  353. }
  354. fail:
  355. free(tib_start_addr);
  356. free(tipb_start_addr);
  357. free(journal_buffer);
  358. }
  359. static int ext4fs_delete_file(int inodeno)
  360. {
  361. struct ext2_inode inode;
  362. short status;
  363. int i;
  364. int remainder;
  365. long int blknr;
  366. int bg_idx;
  367. int ibmap_idx;
  368. char *read_buffer = NULL;
  369. char *start_block_address = NULL;
  370. unsigned int no_blocks;
  371. static int prev_bg_bmap_idx = -1;
  372. unsigned int inodes_per_block;
  373. long int blkno;
  374. unsigned int blkoff;
  375. unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group;
  376. unsigned int inode_per_grp = ext4fs_root->sblock.inodes_per_group;
  377. struct ext2_inode *inode_buffer = NULL;
  378. struct ext2_block_group *bgd = NULL;
  379. struct ext_filesystem *fs = get_fs();
  380. char *journal_buffer = zalloc(fs->blksz);
  381. if (!journal_buffer)
  382. return -ENOMEM;
  383. /* get the block group descriptor table */
  384. bgd = (struct ext2_block_group *)fs->gdtable;
  385. status = ext4fs_read_inode(ext4fs_root, inodeno, &inode);
  386. if (status == 0)
  387. goto fail;
  388. /* read the block no allocated to a file */
  389. no_blocks = inode.size / fs->blksz;
  390. if (inode.size % fs->blksz)
  391. no_blocks++;
  392. if (le32_to_cpu(inode.flags) & EXT4_EXTENTS_FL) {
  393. struct ext2fs_node *node_inode =
  394. zalloc(sizeof(struct ext2fs_node));
  395. if (!node_inode)
  396. goto fail;
  397. node_inode->data = ext4fs_root;
  398. node_inode->ino = inodeno;
  399. node_inode->inode_read = 0;
  400. memcpy(&(node_inode->inode), &inode, sizeof(struct ext2_inode));
  401. for (i = 0; i < no_blocks; i++) {
  402. blknr = read_allocated_block(&(node_inode->inode), i);
  403. bg_idx = blknr / blk_per_grp;
  404. if (fs->blksz == 1024) {
  405. remainder = blknr % blk_per_grp;
  406. if (!remainder)
  407. bg_idx--;
  408. }
  409. ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx],
  410. bg_idx);
  411. debug("EXT4_EXTENTS Block releasing %ld: %d\n",
  412. blknr, bg_idx);
  413. bgd[bg_idx].free_blocks++;
  414. fs->sb->free_blocks++;
  415. /* journal backup */
  416. if (prev_bg_bmap_idx != bg_idx) {
  417. status =
  418. ext4fs_devread((lbaint_t)
  419. bgd[bg_idx].block_id *
  420. fs->sect_perblk, 0,
  421. fs->blksz, journal_buffer);
  422. if (status == 0)
  423. goto fail;
  424. if (ext4fs_log_journal(journal_buffer,
  425. bgd[bg_idx].block_id))
  426. goto fail;
  427. prev_bg_bmap_idx = bg_idx;
  428. }
  429. }
  430. if (node_inode) {
  431. free(node_inode);
  432. node_inode = NULL;
  433. }
  434. } else {
  435. delete_single_indirect_block(&inode);
  436. delete_double_indirect_block(&inode);
  437. delete_triple_indirect_block(&inode);
  438. /* read the block no allocated to a file */
  439. no_blocks = inode.size / fs->blksz;
  440. if (inode.size % fs->blksz)
  441. no_blocks++;
  442. for (i = 0; i < no_blocks; i++) {
  443. blknr = read_allocated_block(&inode, i);
  444. bg_idx = blknr / blk_per_grp;
  445. if (fs->blksz == 1024) {
  446. remainder = blknr % blk_per_grp;
  447. if (!remainder)
  448. bg_idx--;
  449. }
  450. ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx],
  451. bg_idx);
  452. debug("ActualB releasing %ld: %d\n", blknr, bg_idx);
  453. bgd[bg_idx].free_blocks++;
  454. fs->sb->free_blocks++;
  455. /* journal backup */
  456. if (prev_bg_bmap_idx != bg_idx) {
  457. memset(journal_buffer, '\0', fs->blksz);
  458. status = ext4fs_devread((lbaint_t)
  459. bgd[bg_idx].block_id
  460. * fs->sect_perblk,
  461. 0, fs->blksz,
  462. journal_buffer);
  463. if (status == 0)
  464. goto fail;
  465. if (ext4fs_log_journal(journal_buffer,
  466. bgd[bg_idx].block_id))
  467. goto fail;
  468. prev_bg_bmap_idx = bg_idx;
  469. }
  470. }
  471. }
  472. /* from the inode no to blockno */
  473. inodes_per_block = fs->blksz / fs->inodesz;
  474. ibmap_idx = inodeno / inode_per_grp;
  475. /* get the block no */
  476. inodeno--;
  477. blkno = __le32_to_cpu(bgd[ibmap_idx].inode_table_id) +
  478. (inodeno % __le32_to_cpu(inode_per_grp)) / inodes_per_block;
  479. /* get the offset of the inode */
  480. blkoff = ((inodeno) % inodes_per_block) * fs->inodesz;
  481. /* read the block no containing the inode */
  482. read_buffer = zalloc(fs->blksz);
  483. if (!read_buffer)
  484. goto fail;
  485. start_block_address = read_buffer;
  486. status = ext4fs_devread((lbaint_t)blkno * fs->sect_perblk,
  487. 0, fs->blksz, read_buffer);
  488. if (status == 0)
  489. goto fail;
  490. if (ext4fs_log_journal(read_buffer, blkno))
  491. goto fail;
  492. read_buffer = read_buffer + blkoff;
  493. inode_buffer = (struct ext2_inode *)read_buffer;
  494. memset(inode_buffer, '\0', sizeof(struct ext2_inode));
  495. /* write the inode to original position in inode table */
  496. if (ext4fs_put_metadata(start_block_address, blkno))
  497. goto fail;
  498. /* update the respective inode bitmaps */
  499. inodeno++;
  500. ext4fs_reset_inode_bmap(inodeno, fs->inode_bmaps[ibmap_idx], ibmap_idx);
  501. bgd[ibmap_idx].free_inodes++;
  502. fs->sb->free_inodes++;
  503. /* journal backup */
  504. memset(journal_buffer, '\0', fs->blksz);
  505. status = ext4fs_devread((lbaint_t)bgd[ibmap_idx].inode_id *
  506. fs->sect_perblk, 0, fs->blksz, journal_buffer);
  507. if (status == 0)
  508. goto fail;
  509. if (ext4fs_log_journal(journal_buffer, bgd[ibmap_idx].inode_id))
  510. goto fail;
  511. ext4fs_update();
  512. ext4fs_deinit();
  513. ext4fs_reinit_global();
  514. if (ext4fs_init() != 0) {
  515. printf("error in File System init\n");
  516. goto fail;
  517. }
  518. free(start_block_address);
  519. free(journal_buffer);
  520. return 0;
  521. fail:
  522. free(start_block_address);
  523. free(journal_buffer);
  524. return -1;
  525. }
  526. int ext4fs_init(void)
  527. {
  528. short status;
  529. int i;
  530. unsigned int real_free_blocks = 0;
  531. struct ext_filesystem *fs = get_fs();
  532. /* populate fs */
  533. fs->blksz = EXT2_BLOCK_SIZE(ext4fs_root);
  534. fs->inodesz = INODE_SIZE_FILESYSTEM(ext4fs_root);
  535. fs->sect_perblk = fs->blksz >> fs->dev_desc->log2blksz;
  536. /* get the superblock */
  537. fs->sb = zalloc(SUPERBLOCK_SIZE);
  538. if (!fs->sb)
  539. return -ENOMEM;
  540. if (!ext4_read_superblock((char *)fs->sb))
  541. goto fail;
  542. /* init journal */
  543. if (ext4fs_init_journal())
  544. goto fail;
  545. /* get total no of blockgroups */
  546. fs->no_blkgrp = (uint32_t)ext4fs_div_roundup(
  547. (ext4fs_root->sblock.total_blocks -
  548. ext4fs_root->sblock.first_data_block),
  549. ext4fs_root->sblock.blocks_per_group);
  550. /* get the block group descriptor table */
  551. fs->gdtable_blkno = ((EXT2_MIN_BLOCK_SIZE == fs->blksz) + 1);
  552. if (ext4fs_get_bgdtable() == -1) {
  553. printf("Error in getting the block group descriptor table\n");
  554. goto fail;
  555. }
  556. fs->bgd = (struct ext2_block_group *)fs->gdtable;
  557. /* load all the available bitmap block of the partition */
  558. fs->blk_bmaps = zalloc(fs->no_blkgrp * sizeof(char *));
  559. if (!fs->blk_bmaps)
  560. goto fail;
  561. for (i = 0; i < fs->no_blkgrp; i++) {
  562. fs->blk_bmaps[i] = zalloc(fs->blksz);
  563. if (!fs->blk_bmaps[i])
  564. goto fail;
  565. }
  566. for (i = 0; i < fs->no_blkgrp; i++) {
  567. status =
  568. ext4fs_devread((lbaint_t)fs->bgd[i].block_id *
  569. fs->sect_perblk, 0,
  570. fs->blksz, (char *)fs->blk_bmaps[i]);
  571. if (status == 0)
  572. goto fail;
  573. }
  574. /* load all the available inode bitmap of the partition */
  575. fs->inode_bmaps = zalloc(fs->no_blkgrp * sizeof(unsigned char *));
  576. if (!fs->inode_bmaps)
  577. goto fail;
  578. for (i = 0; i < fs->no_blkgrp; i++) {
  579. fs->inode_bmaps[i] = zalloc(fs->blksz);
  580. if (!fs->inode_bmaps[i])
  581. goto fail;
  582. }
  583. for (i = 0; i < fs->no_blkgrp; i++) {
  584. status = ext4fs_devread((lbaint_t)fs->bgd[i].inode_id *
  585. fs->sect_perblk,
  586. 0, fs->blksz,
  587. (char *)fs->inode_bmaps[i]);
  588. if (status == 0)
  589. goto fail;
  590. }
  591. /*
  592. * check filesystem consistency with free blocks of file system
  593. * some time we observed that superblock freeblocks does not match
  594. * with the blockgroups freeblocks when improper
  595. * reboot of a linux kernel
  596. */
  597. for (i = 0; i < fs->no_blkgrp; i++)
  598. real_free_blocks = real_free_blocks + fs->bgd[i].free_blocks;
  599. if (real_free_blocks != fs->sb->free_blocks)
  600. fs->sb->free_blocks = real_free_blocks;
  601. return 0;
  602. fail:
  603. ext4fs_deinit();
  604. return -1;
  605. }
  606. void ext4fs_deinit(void)
  607. {
  608. int i;
  609. struct ext2_inode inode_journal;
  610. struct journal_superblock_t *jsb;
  611. long int blknr;
  612. struct ext_filesystem *fs = get_fs();
  613. /* free journal */
  614. char *temp_buff = zalloc(fs->blksz);
  615. if (temp_buff) {
  616. ext4fs_read_inode(ext4fs_root, EXT2_JOURNAL_INO,
  617. &inode_journal);
  618. blknr = read_allocated_block(&inode_journal,
  619. EXT2_JOURNAL_SUPERBLOCK);
  620. ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, fs->blksz,
  621. temp_buff);
  622. jsb = (struct journal_superblock_t *)temp_buff;
  623. jsb->s_start = cpu_to_be32(0);
  624. put_ext4((uint64_t) ((uint64_t)blknr * (uint64_t)fs->blksz),
  625. (struct journal_superblock_t *)temp_buff, fs->blksz);
  626. free(temp_buff);
  627. }
  628. ext4fs_free_journal();
  629. /* get the superblock */
  630. ext4_read_superblock((char *)fs->sb);
  631. fs->sb->feature_incompat &= ~EXT3_FEATURE_INCOMPAT_RECOVER;
  632. put_ext4((uint64_t)(SUPERBLOCK_SIZE),
  633. (struct ext2_sblock *)fs->sb, (uint32_t)SUPERBLOCK_SIZE);
  634. free(fs->sb);
  635. fs->sb = NULL;
  636. if (fs->blk_bmaps) {
  637. for (i = 0; i < fs->no_blkgrp; i++) {
  638. free(fs->blk_bmaps[i]);
  639. fs->blk_bmaps[i] = NULL;
  640. }
  641. free(fs->blk_bmaps);
  642. fs->blk_bmaps = NULL;
  643. }
  644. if (fs->inode_bmaps) {
  645. for (i = 0; i < fs->no_blkgrp; i++) {
  646. free(fs->inode_bmaps[i]);
  647. fs->inode_bmaps[i] = NULL;
  648. }
  649. free(fs->inode_bmaps);
  650. fs->inode_bmaps = NULL;
  651. }
  652. free(fs->gdtable);
  653. fs->gdtable = NULL;
  654. fs->bgd = NULL;
  655. /*
  656. * reinitiliazed the global inode and
  657. * block bitmap first execution check variables
  658. */
  659. fs->first_pass_ibmap = 0;
  660. fs->first_pass_bbmap = 0;
  661. fs->curr_inode_no = 0;
  662. fs->curr_blkno = 0;
  663. }
  664. static int ext4fs_write_file(struct ext2_inode *file_inode,
  665. int pos, unsigned int len, char *buf)
  666. {
  667. int i;
  668. int blockcnt;
  669. unsigned int filesize = __le32_to_cpu(file_inode->size);
  670. struct ext_filesystem *fs = get_fs();
  671. int log2blksz = fs->dev_desc->log2blksz;
  672. int log2_fs_blocksize = LOG2_BLOCK_SIZE(ext4fs_root) - log2blksz;
  673. int previous_block_number = -1;
  674. int delayed_start = 0;
  675. int delayed_extent = 0;
  676. int delayed_next = 0;
  677. char *delayed_buf = NULL;
  678. /* Adjust len so it we can't read past the end of the file. */
  679. if (len > filesize)
  680. len = filesize;
  681. blockcnt = ((len + pos) + fs->blksz - 1) / fs->blksz;
  682. for (i = pos / fs->blksz; i < blockcnt; i++) {
  683. long int blknr;
  684. int blockend = fs->blksz;
  685. int skipfirst = 0;
  686. blknr = read_allocated_block(file_inode, i);
  687. if (blknr < 0)
  688. return -1;
  689. blknr = blknr << log2_fs_blocksize;
  690. if (blknr) {
  691. if (previous_block_number != -1) {
  692. if (delayed_next == blknr) {
  693. delayed_extent += blockend;
  694. delayed_next += blockend >> log2blksz;
  695. } else { /* spill */
  696. put_ext4((uint64_t)
  697. ((uint64_t)delayed_start << log2blksz),
  698. delayed_buf,
  699. (uint32_t) delayed_extent);
  700. previous_block_number = blknr;
  701. delayed_start = blknr;
  702. delayed_extent = blockend;
  703. delayed_buf = buf;
  704. delayed_next = blknr +
  705. (blockend >> log2blksz);
  706. }
  707. } else {
  708. previous_block_number = blknr;
  709. delayed_start = blknr;
  710. delayed_extent = blockend;
  711. delayed_buf = buf;
  712. delayed_next = blknr +
  713. (blockend >> log2blksz);
  714. }
  715. } else {
  716. if (previous_block_number != -1) {
  717. /* spill */
  718. put_ext4((uint64_t) ((uint64_t)delayed_start <<
  719. log2blksz),
  720. delayed_buf,
  721. (uint32_t) delayed_extent);
  722. previous_block_number = -1;
  723. }
  724. memset(buf, 0, fs->blksz - skipfirst);
  725. }
  726. buf += fs->blksz - skipfirst;
  727. }
  728. if (previous_block_number != -1) {
  729. /* spill */
  730. put_ext4((uint64_t) ((uint64_t)delayed_start << log2blksz),
  731. delayed_buf, (uint32_t) delayed_extent);
  732. previous_block_number = -1;
  733. }
  734. return len;
  735. }
  736. int ext4fs_write(const char *fname, unsigned char *buffer,
  737. unsigned long sizebytes)
  738. {
  739. int ret = 0;
  740. struct ext2_inode *file_inode = NULL;
  741. unsigned char *inode_buffer = NULL;
  742. int parent_inodeno;
  743. int inodeno;
  744. time_t timestamp = 0;
  745. uint64_t bytes_reqd_for_file;
  746. unsigned int blks_reqd_for_file;
  747. unsigned int blocks_remaining;
  748. int existing_file_inodeno;
  749. char *temp_ptr = NULL;
  750. long int itable_blkno;
  751. long int parent_itable_blkno;
  752. long int blkoff;
  753. struct ext2_sblock *sblock = &(ext4fs_root->sblock);
  754. unsigned int inodes_per_block;
  755. unsigned int ibmap_idx;
  756. struct ext_filesystem *fs = get_fs();
  757. ALLOC_CACHE_ALIGN_BUFFER(char, filename, 256);
  758. memset(filename, 0x00, 256);
  759. g_parent_inode = zalloc(sizeof(struct ext2_inode));
  760. if (!g_parent_inode)
  761. goto fail;
  762. if (ext4fs_init() != 0) {
  763. printf("error in File System init\n");
  764. return -1;
  765. }
  766. inodes_per_block = fs->blksz / fs->inodesz;
  767. parent_inodeno = ext4fs_get_parent_inode_num(fname, filename, F_FILE);
  768. if (parent_inodeno == -1)
  769. goto fail;
  770. if (ext4fs_iget(parent_inodeno, g_parent_inode))
  771. goto fail;
  772. /* check if the filename is already present in root */
  773. existing_file_inodeno = ext4fs_filename_check(filename);
  774. if (existing_file_inodeno != -1) {
  775. ret = ext4fs_delete_file(existing_file_inodeno);
  776. fs->first_pass_bbmap = 0;
  777. fs->curr_blkno = 0;
  778. fs->first_pass_ibmap = 0;
  779. fs->curr_inode_no = 0;
  780. if (ret)
  781. goto fail;
  782. }
  783. /* calucalate how many blocks required */
  784. bytes_reqd_for_file = sizebytes;
  785. blks_reqd_for_file = lldiv(bytes_reqd_for_file, fs->blksz);
  786. if (do_div(bytes_reqd_for_file, fs->blksz) != 0) {
  787. blks_reqd_for_file++;
  788. debug("total bytes for a file %u\n", blks_reqd_for_file);
  789. }
  790. blocks_remaining = blks_reqd_for_file;
  791. /* test for available space in partition */
  792. if (fs->sb->free_blocks < blks_reqd_for_file) {
  793. printf("Not enough space on partition !!!\n");
  794. goto fail;
  795. }
  796. ext4fs_update_parent_dentry(filename, &inodeno, FILETYPE_REG);
  797. /* prepare file inode */
  798. inode_buffer = zalloc(fs->inodesz);
  799. if (!inode_buffer)
  800. goto fail;
  801. file_inode = (struct ext2_inode *)inode_buffer;
  802. file_inode->mode = S_IFREG | S_IRWXU |
  803. S_IRGRP | S_IROTH | S_IXGRP | S_IXOTH;
  804. /* ToDo: Update correct time */
  805. file_inode->mtime = timestamp;
  806. file_inode->atime = timestamp;
  807. file_inode->ctime = timestamp;
  808. file_inode->nlinks = 1;
  809. file_inode->size = sizebytes;
  810. /* Allocate data blocks */
  811. ext4fs_allocate_blocks(file_inode, blocks_remaining,
  812. &blks_reqd_for_file);
  813. file_inode->blockcnt = (blks_reqd_for_file * fs->blksz) >>
  814. fs->dev_desc->log2blksz;
  815. temp_ptr = zalloc(fs->blksz);
  816. if (!temp_ptr)
  817. goto fail;
  818. ibmap_idx = inodeno / ext4fs_root->sblock.inodes_per_group;
  819. inodeno--;
  820. itable_blkno = __le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) +
  821. (inodeno % __le32_to_cpu(sblock->inodes_per_group)) /
  822. inodes_per_block;
  823. blkoff = (inodeno % inodes_per_block) * fs->inodesz;
  824. ext4fs_devread((lbaint_t)itable_blkno * fs->sect_perblk, 0, fs->blksz,
  825. temp_ptr);
  826. if (ext4fs_log_journal(temp_ptr, itable_blkno))
  827. goto fail;
  828. memcpy(temp_ptr + blkoff, inode_buffer, fs->inodesz);
  829. if (ext4fs_put_metadata(temp_ptr, itable_blkno))
  830. goto fail;
  831. /* copy the file content into data blocks */
  832. if (ext4fs_write_file(file_inode, 0, sizebytes, (char *)buffer) == -1) {
  833. printf("Error in copying content\n");
  834. goto fail;
  835. }
  836. ibmap_idx = parent_inodeno / ext4fs_root->sblock.inodes_per_group;
  837. parent_inodeno--;
  838. parent_itable_blkno = __le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) +
  839. (parent_inodeno %
  840. __le32_to_cpu(sblock->inodes_per_group)) / inodes_per_block;
  841. blkoff = (parent_inodeno % inodes_per_block) * fs->inodesz;
  842. if (parent_itable_blkno != itable_blkno) {
  843. memset(temp_ptr, '\0', fs->blksz);
  844. ext4fs_devread((lbaint_t)parent_itable_blkno * fs->sect_perblk,
  845. 0, fs->blksz, temp_ptr);
  846. if (ext4fs_log_journal(temp_ptr, parent_itable_blkno))
  847. goto fail;
  848. memcpy(temp_ptr + blkoff, g_parent_inode,
  849. sizeof(struct ext2_inode));
  850. if (ext4fs_put_metadata(temp_ptr, parent_itable_blkno))
  851. goto fail;
  852. free(temp_ptr);
  853. } else {
  854. /*
  855. * If parent and child fall in same inode table block
  856. * both should be kept in 1 buffer
  857. */
  858. memcpy(temp_ptr + blkoff, g_parent_inode,
  859. sizeof(struct ext2_inode));
  860. gd_index--;
  861. if (ext4fs_put_metadata(temp_ptr, itable_blkno))
  862. goto fail;
  863. free(temp_ptr);
  864. }
  865. ext4fs_update();
  866. ext4fs_deinit();
  867. fs->first_pass_bbmap = 0;
  868. fs->curr_blkno = 0;
  869. fs->first_pass_ibmap = 0;
  870. fs->curr_inode_no = 0;
  871. free(inode_buffer);
  872. free(g_parent_inode);
  873. g_parent_inode = NULL;
  874. return 0;
  875. fail:
  876. ext4fs_deinit();
  877. free(inode_buffer);
  878. free(g_parent_inode);
  879. g_parent_inode = NULL;
  880. return -1;
  881. }
  882. int ext4_write_file(const char *filename, void *buf, loff_t offset,
  883. loff_t len, loff_t *actwrite)
  884. {
  885. int ret;
  886. if (offset != 0) {
  887. printf("** Cannot support non-zero offset **\n");
  888. return -1;
  889. }
  890. /* mount the filesystem */
  891. if (!ext4fs_mount(0)) {
  892. printf("** Error Bad ext4 partition **\n");
  893. goto fail;
  894. }
  895. ret = ext4fs_write(filename, buf, len);
  896. if (ret) {
  897. printf("** Error ext4fs_write() **\n");
  898. goto fail;
  899. }
  900. ext4fs_close();
  901. *actwrite = len;
  902. return 0;
  903. fail:
  904. ext4fs_close();
  905. *actwrite = 0;
  906. return -1;
  907. }