ext4_write.c 26 KB

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