ext4fs.c 30 KB

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