xref: /rk3399_rockchip-uboot/fs/ext4/ext4_write.c (revision 50ce4c07df1c98aabf4630b35152ed95a87242f7)
1293d7fbdSSimon Glass /*
2293d7fbdSSimon Glass  * (C) Copyright 2011 - 2012 Samsung Electronics
3293d7fbdSSimon Glass  * EXT4 filesystem implementation in Uboot by
4293d7fbdSSimon Glass  * Uma Shankar <uma.shankar@samsung.com>
5293d7fbdSSimon Glass  * Manjunatha C Achar <a.manjunatha@samsung.com>
6293d7fbdSSimon Glass  *
7293d7fbdSSimon Glass  * ext4ls and ext4load : Based on ext2 ls and load support in Uboot.
8293d7fbdSSimon Glass  *		       Ext4 read optimization taken from Open-Moko
9293d7fbdSSimon Glass  *		       Qi bootloader
10293d7fbdSSimon Glass  *
11293d7fbdSSimon Glass  * (C) Copyright 2004
12293d7fbdSSimon Glass  * esd gmbh <www.esd-electronics.com>
13293d7fbdSSimon Glass  * Reinhard Arlt <reinhard.arlt@esd-electronics.com>
14293d7fbdSSimon Glass  *
15293d7fbdSSimon Glass  * based on code from grub2 fs/ext2.c and fs/fshelp.c by
16293d7fbdSSimon Glass  * GRUB  --  GRand Unified Bootloader
17293d7fbdSSimon Glass  * Copyright (C) 2003, 2004  Free Software Foundation, Inc.
18293d7fbdSSimon Glass  *
19293d7fbdSSimon Glass  * ext4write : Based on generic ext4 protocol.
20293d7fbdSSimon Glass  *
21293d7fbdSSimon Glass  * This program is free software; you can redistribute it and/or modify
22293d7fbdSSimon Glass  * it under the terms of the GNU General Public License as published by
23293d7fbdSSimon Glass  * the Free Software Foundation; either version 2 of the License, or
24293d7fbdSSimon Glass  * (at your option) any later version.
25293d7fbdSSimon Glass  *
26293d7fbdSSimon Glass  * This program is distributed in the hope that it will be useful,
27293d7fbdSSimon Glass  * but WITHOUT ANY WARRANTY; without even the implied warranty of
28293d7fbdSSimon Glass  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
29293d7fbdSSimon Glass  * GNU General Public License for more details.
30293d7fbdSSimon Glass  *
31293d7fbdSSimon Glass  * You should have received a copy of the GNU General Public License
32293d7fbdSSimon Glass  * along with this program; if not, write to the Free Software
33293d7fbdSSimon Glass  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
34293d7fbdSSimon Glass  */
35293d7fbdSSimon Glass 
36293d7fbdSSimon Glass 
37293d7fbdSSimon Glass #include <common.h>
38293d7fbdSSimon Glass #include <linux/stat.h>
39293d7fbdSSimon Glass #include <div64.h>
40293d7fbdSSimon Glass #include "ext4_common.h"
41293d7fbdSSimon Glass 
42293d7fbdSSimon Glass static void ext4fs_update(void)
43293d7fbdSSimon Glass {
44293d7fbdSSimon Glass 	short i;
45293d7fbdSSimon Glass 	ext4fs_update_journal();
46293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
47293d7fbdSSimon Glass 
48293d7fbdSSimon Glass 	/* update  super block */
49293d7fbdSSimon Glass 	put_ext4((uint64_t)(SUPERBLOCK_SIZE),
50293d7fbdSSimon Glass 		 (struct ext2_sblock *)fs->sb, (uint32_t)SUPERBLOCK_SIZE);
51293d7fbdSSimon Glass 
52293d7fbdSSimon Glass 	/* update block groups */
53293d7fbdSSimon Glass 	for (i = 0; i < fs->no_blkgrp; i++) {
54293d7fbdSSimon Glass 		fs->bgd[i].bg_checksum = ext4fs_checksum_update(i);
55293d7fbdSSimon Glass 		put_ext4((uint64_t)(fs->bgd[i].block_id * fs->blksz),
56293d7fbdSSimon Glass 			 fs->blk_bmaps[i], fs->blksz);
57293d7fbdSSimon Glass 	}
58293d7fbdSSimon Glass 
59293d7fbdSSimon Glass 	/* update inode table groups */
60293d7fbdSSimon Glass 	for (i = 0; i < fs->no_blkgrp; i++) {
61293d7fbdSSimon Glass 		put_ext4((uint64_t) (fs->bgd[i].inode_id * fs->blksz),
62293d7fbdSSimon Glass 			 fs->inode_bmaps[i], fs->blksz);
63293d7fbdSSimon Glass 	}
64293d7fbdSSimon Glass 
65293d7fbdSSimon Glass 	/* update the block group descriptor table */
66293d7fbdSSimon Glass 	put_ext4((uint64_t)(fs->gdtable_blkno * fs->blksz),
67293d7fbdSSimon Glass 		 (struct ext2_block_group *)fs->gdtable,
68293d7fbdSSimon Glass 		 (fs->blksz * fs->no_blk_pergdt));
69293d7fbdSSimon Glass 
70293d7fbdSSimon Glass 	ext4fs_dump_metadata();
71293d7fbdSSimon Glass 
72293d7fbdSSimon Glass 	gindex = 0;
73293d7fbdSSimon Glass 	gd_index = 0;
74293d7fbdSSimon Glass }
75293d7fbdSSimon Glass 
76293d7fbdSSimon Glass int ext4fs_get_bgdtable(void)
77293d7fbdSSimon Glass {
78293d7fbdSSimon Glass 	int status;
79293d7fbdSSimon Glass 	int grp_desc_size;
80293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
81293d7fbdSSimon Glass 	grp_desc_size = sizeof(struct ext2_block_group);
82293d7fbdSSimon Glass 	fs->no_blk_pergdt = (fs->no_blkgrp * grp_desc_size) / fs->blksz;
83293d7fbdSSimon Glass 	if ((fs->no_blkgrp * grp_desc_size) % fs->blksz)
84293d7fbdSSimon Glass 		fs->no_blk_pergdt++;
85293d7fbdSSimon Glass 
86293d7fbdSSimon Glass 	/* allocate memory for gdtable */
87293d7fbdSSimon Glass 	fs->gdtable = zalloc(fs->blksz * fs->no_blk_pergdt);
88293d7fbdSSimon Glass 	if (!fs->gdtable)
89293d7fbdSSimon Glass 		return -ENOMEM;
90293d7fbdSSimon Glass 	/* read the group descriptor table */
91293d7fbdSSimon Glass 	status = ext4fs_devread(fs->gdtable_blkno * fs->sect_perblk, 0,
92293d7fbdSSimon Glass 				fs->blksz * fs->no_blk_pergdt, fs->gdtable);
93293d7fbdSSimon Glass 	if (status == 0)
94293d7fbdSSimon Glass 		goto fail;
95293d7fbdSSimon Glass 
96293d7fbdSSimon Glass 	if (ext4fs_log_gdt(fs->gdtable)) {
97293d7fbdSSimon Glass 		printf("Error in ext4fs_log_gdt\n");
98293d7fbdSSimon Glass 		return -1;
99293d7fbdSSimon Glass 	}
100293d7fbdSSimon Glass 
101293d7fbdSSimon Glass 	return 0;
102293d7fbdSSimon Glass fail:
103293d7fbdSSimon Glass 	free(fs->gdtable);
104293d7fbdSSimon Glass 	fs->gdtable = NULL;
105293d7fbdSSimon Glass 
106293d7fbdSSimon Glass 	return -1;
107293d7fbdSSimon Glass }
108293d7fbdSSimon Glass 
109293d7fbdSSimon Glass static void delete_single_indirect_block(struct ext2_inode *inode)
110293d7fbdSSimon Glass {
111293d7fbdSSimon Glass 	struct ext2_block_group *bgd = NULL;
112293d7fbdSSimon Glass 	static int prev_bg_bmap_idx = -1;
113293d7fbdSSimon Glass 	long int blknr;
114293d7fbdSSimon Glass 	int remainder;
115293d7fbdSSimon Glass 	int bg_idx;
116293d7fbdSSimon Glass 	int status;
117293d7fbdSSimon Glass 	unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group;
118293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
119293d7fbdSSimon Glass 	char *journal_buffer = zalloc(fs->blksz);
120293d7fbdSSimon Glass 	if (!journal_buffer) {
121293d7fbdSSimon Glass 		printf("No memory\n");
122293d7fbdSSimon Glass 		return;
123293d7fbdSSimon Glass 	}
124293d7fbdSSimon Glass 	/* get  block group descriptor table */
125293d7fbdSSimon Glass 	bgd = (struct ext2_block_group *)fs->gdtable;
126293d7fbdSSimon Glass 
127293d7fbdSSimon Glass 	/* deleting the single indirect block associated with inode */
128293d7fbdSSimon Glass 	if (inode->b.blocks.indir_block != 0) {
129293d7fbdSSimon Glass 		debug("SIPB releasing %u\n", inode->b.blocks.indir_block);
130293d7fbdSSimon Glass 		blknr = inode->b.blocks.indir_block;
131293d7fbdSSimon Glass 		if (fs->blksz != 1024) {
132293d7fbdSSimon Glass 			bg_idx = blknr / blk_per_grp;
133293d7fbdSSimon Glass 		} else {
134293d7fbdSSimon Glass 			bg_idx = blknr / blk_per_grp;
135293d7fbdSSimon Glass 			remainder = blknr % blk_per_grp;
136293d7fbdSSimon Glass 			if (!remainder)
137293d7fbdSSimon Glass 				bg_idx--;
138293d7fbdSSimon Glass 		}
139293d7fbdSSimon Glass 		ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx);
140293d7fbdSSimon Glass 		bgd[bg_idx].free_blocks++;
141293d7fbdSSimon Glass 		fs->sb->free_blocks++;
142293d7fbdSSimon Glass 		/* journal backup */
143293d7fbdSSimon Glass 		if (prev_bg_bmap_idx != bg_idx) {
144293d7fbdSSimon Glass 			status =
145293d7fbdSSimon Glass 			    ext4fs_devread(bgd[bg_idx].block_id *
146293d7fbdSSimon Glass 					   fs->sect_perblk, 0, fs->blksz,
147293d7fbdSSimon Glass 					   journal_buffer);
148293d7fbdSSimon Glass 			if (status == 0)
149293d7fbdSSimon Glass 				goto fail;
150293d7fbdSSimon Glass 			if (ext4fs_log_journal
151293d7fbdSSimon Glass 			    (journal_buffer, bgd[bg_idx].block_id))
152293d7fbdSSimon Glass 				goto fail;
153293d7fbdSSimon Glass 			prev_bg_bmap_idx = bg_idx;
154293d7fbdSSimon Glass 		}
155293d7fbdSSimon Glass 	}
156293d7fbdSSimon Glass fail:
157293d7fbdSSimon Glass 	free(journal_buffer);
158293d7fbdSSimon Glass }
159293d7fbdSSimon Glass 
160293d7fbdSSimon Glass static void delete_double_indirect_block(struct ext2_inode *inode)
161293d7fbdSSimon Glass {
162293d7fbdSSimon Glass 	int i;
163293d7fbdSSimon Glass 	short status;
164293d7fbdSSimon Glass 	static int prev_bg_bmap_idx = -1;
165293d7fbdSSimon Glass 	long int blknr;
166293d7fbdSSimon Glass 	int remainder;
167293d7fbdSSimon Glass 	int bg_idx;
168293d7fbdSSimon Glass 	unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group;
169293d7fbdSSimon Glass 	unsigned int *di_buffer = NULL;
170293d7fbdSSimon Glass 	unsigned int *DIB_start_addr = NULL;
171293d7fbdSSimon Glass 	struct ext2_block_group *bgd = NULL;
172293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
173293d7fbdSSimon Glass 	char *journal_buffer = zalloc(fs->blksz);
174293d7fbdSSimon Glass 	if (!journal_buffer) {
175293d7fbdSSimon Glass 		printf("No memory\n");
176293d7fbdSSimon Glass 		return;
177293d7fbdSSimon Glass 	}
178293d7fbdSSimon Glass 	/* get the block group descriptor table */
179293d7fbdSSimon Glass 	bgd = (struct ext2_block_group *)fs->gdtable;
180293d7fbdSSimon Glass 
181293d7fbdSSimon Glass 	if (inode->b.blocks.double_indir_block != 0) {
182293d7fbdSSimon Glass 		di_buffer = zalloc(fs->blksz);
183293d7fbdSSimon Glass 		if (!di_buffer) {
184293d7fbdSSimon Glass 			printf("No memory\n");
185293d7fbdSSimon Glass 			return;
186293d7fbdSSimon Glass 		}
187293d7fbdSSimon Glass 		DIB_start_addr = (unsigned int *)di_buffer;
188293d7fbdSSimon Glass 		blknr = inode->b.blocks.double_indir_block;
189293d7fbdSSimon Glass 		status = ext4fs_devread(blknr * fs->sect_perblk, 0, fs->blksz,
190293d7fbdSSimon Glass 					(char *)di_buffer);
191293d7fbdSSimon Glass 		for (i = 0; i < fs->blksz / sizeof(int); i++) {
192293d7fbdSSimon Glass 			if (*di_buffer == 0)
193293d7fbdSSimon Glass 				break;
194293d7fbdSSimon Glass 
195293d7fbdSSimon Glass 			debug("DICB releasing %u\n", *di_buffer);
196293d7fbdSSimon Glass 			if (fs->blksz != 1024) {
197293d7fbdSSimon Glass 				bg_idx = (*di_buffer) / blk_per_grp;
198293d7fbdSSimon Glass 			} else {
199293d7fbdSSimon Glass 				bg_idx = (*di_buffer) / blk_per_grp;
200293d7fbdSSimon Glass 				remainder = (*di_buffer) % blk_per_grp;
201293d7fbdSSimon Glass 				if (!remainder)
202293d7fbdSSimon Glass 					bg_idx--;
203293d7fbdSSimon Glass 			}
204293d7fbdSSimon Glass 			ext4fs_reset_block_bmap(*di_buffer,
205293d7fbdSSimon Glass 					fs->blk_bmaps[bg_idx], bg_idx);
206293d7fbdSSimon Glass 			di_buffer++;
207293d7fbdSSimon Glass 			bgd[bg_idx].free_blocks++;
208293d7fbdSSimon Glass 			fs->sb->free_blocks++;
209293d7fbdSSimon Glass 			/* journal backup */
210293d7fbdSSimon Glass 			if (prev_bg_bmap_idx != bg_idx) {
211293d7fbdSSimon Glass 				status = ext4fs_devread(bgd[bg_idx].block_id
212293d7fbdSSimon Glass 							* fs->sect_perblk, 0,
213293d7fbdSSimon Glass 							fs->blksz,
214293d7fbdSSimon Glass 							journal_buffer);
215293d7fbdSSimon Glass 				if (status == 0)
216293d7fbdSSimon Glass 					goto fail;
217293d7fbdSSimon Glass 
218293d7fbdSSimon Glass 				if (ext4fs_log_journal(journal_buffer,
219293d7fbdSSimon Glass 							bgd[bg_idx].block_id))
220293d7fbdSSimon Glass 					goto fail;
221293d7fbdSSimon Glass 				prev_bg_bmap_idx = bg_idx;
222293d7fbdSSimon Glass 			}
223293d7fbdSSimon Glass 		}
224293d7fbdSSimon Glass 
225293d7fbdSSimon Glass 		/* removing the parent double indirect block */
226293d7fbdSSimon Glass 		blknr = inode->b.blocks.double_indir_block;
227293d7fbdSSimon Glass 		if (fs->blksz != 1024) {
228293d7fbdSSimon Glass 			bg_idx = blknr / blk_per_grp;
229293d7fbdSSimon Glass 		} else {
230293d7fbdSSimon Glass 			bg_idx = blknr / blk_per_grp;
231293d7fbdSSimon Glass 			remainder = blknr % blk_per_grp;
232293d7fbdSSimon Glass 			if (!remainder)
233293d7fbdSSimon Glass 				bg_idx--;
234293d7fbdSSimon Glass 		}
235293d7fbdSSimon Glass 		ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx);
236293d7fbdSSimon Glass 		bgd[bg_idx].free_blocks++;
237293d7fbdSSimon Glass 		fs->sb->free_blocks++;
238293d7fbdSSimon Glass 		/* journal backup */
239293d7fbdSSimon Glass 		if (prev_bg_bmap_idx != bg_idx) {
240293d7fbdSSimon Glass 			memset(journal_buffer, '\0', fs->blksz);
241293d7fbdSSimon Glass 			status = ext4fs_devread(bgd[bg_idx].block_id *
242293d7fbdSSimon Glass 						fs->sect_perblk, 0, fs->blksz,
243293d7fbdSSimon Glass 						journal_buffer);
244293d7fbdSSimon Glass 			if (status == 0)
245293d7fbdSSimon Glass 				goto fail;
246293d7fbdSSimon Glass 
247293d7fbdSSimon Glass 			if (ext4fs_log_journal(journal_buffer,
248293d7fbdSSimon Glass 						bgd[bg_idx].block_id))
249293d7fbdSSimon Glass 				goto fail;
250293d7fbdSSimon Glass 			prev_bg_bmap_idx = bg_idx;
251293d7fbdSSimon Glass 		}
252293d7fbdSSimon Glass 		debug("DIPB releasing %ld\n", blknr);
253293d7fbdSSimon Glass 	}
254293d7fbdSSimon Glass fail:
255293d7fbdSSimon Glass 	free(DIB_start_addr);
256293d7fbdSSimon Glass 	free(journal_buffer);
257293d7fbdSSimon Glass }
258293d7fbdSSimon Glass 
259293d7fbdSSimon Glass static void delete_triple_indirect_block(struct ext2_inode *inode)
260293d7fbdSSimon Glass {
261293d7fbdSSimon Glass 	int i, j;
262293d7fbdSSimon Glass 	short status;
263293d7fbdSSimon Glass 	static int prev_bg_bmap_idx = -1;
264293d7fbdSSimon Glass 	long int blknr;
265293d7fbdSSimon Glass 	int remainder;
266293d7fbdSSimon Glass 	int bg_idx;
267293d7fbdSSimon Glass 	unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group;
268293d7fbdSSimon Glass 	unsigned int *tigp_buffer = NULL;
269293d7fbdSSimon Glass 	unsigned int *tib_start_addr = NULL;
270293d7fbdSSimon Glass 	unsigned int *tip_buffer = NULL;
271293d7fbdSSimon Glass 	unsigned int *tipb_start_addr = NULL;
272293d7fbdSSimon Glass 	struct ext2_block_group *bgd = NULL;
273293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
274293d7fbdSSimon Glass 	char *journal_buffer = zalloc(fs->blksz);
275293d7fbdSSimon Glass 	if (!journal_buffer) {
276293d7fbdSSimon Glass 		printf("No memory\n");
277293d7fbdSSimon Glass 		return;
278293d7fbdSSimon Glass 	}
279293d7fbdSSimon Glass 	/* get block group descriptor table */
280293d7fbdSSimon Glass 	bgd = (struct ext2_block_group *)fs->gdtable;
281293d7fbdSSimon Glass 
282293d7fbdSSimon Glass 	if (inode->b.blocks.triple_indir_block != 0) {
283293d7fbdSSimon Glass 		tigp_buffer = zalloc(fs->blksz);
284293d7fbdSSimon Glass 		if (!tigp_buffer) {
285293d7fbdSSimon Glass 			printf("No memory\n");
286293d7fbdSSimon Glass 			return;
287293d7fbdSSimon Glass 		}
288293d7fbdSSimon Glass 		tib_start_addr = (unsigned int *)tigp_buffer;
289293d7fbdSSimon Glass 		blknr = inode->b.blocks.triple_indir_block;
290293d7fbdSSimon Glass 		status = ext4fs_devread(blknr * fs->sect_perblk, 0, fs->blksz,
291293d7fbdSSimon Glass 					(char *)tigp_buffer);
292293d7fbdSSimon Glass 		for (i = 0; i < fs->blksz / sizeof(int); i++) {
293293d7fbdSSimon Glass 			if (*tigp_buffer == 0)
294293d7fbdSSimon Glass 				break;
295293d7fbdSSimon Glass 			debug("tigp buffer releasing %u\n", *tigp_buffer);
296293d7fbdSSimon Glass 
297293d7fbdSSimon Glass 			tip_buffer = zalloc(fs->blksz);
298293d7fbdSSimon Glass 			if (!tip_buffer)
299293d7fbdSSimon Glass 				goto fail;
300293d7fbdSSimon Glass 			tipb_start_addr = (unsigned int *)tip_buffer;
301293d7fbdSSimon Glass 			status = ext4fs_devread((*tigp_buffer) *
302293d7fbdSSimon Glass 						fs->sect_perblk, 0, fs->blksz,
303293d7fbdSSimon Glass 						(char *)tip_buffer);
304293d7fbdSSimon Glass 			for (j = 0; j < fs->blksz / sizeof(int); j++) {
305293d7fbdSSimon Glass 				if (*tip_buffer == 0)
306293d7fbdSSimon Glass 					break;
307293d7fbdSSimon Glass 				if (fs->blksz != 1024) {
308293d7fbdSSimon Glass 					bg_idx = (*tip_buffer) / blk_per_grp;
309293d7fbdSSimon Glass 				} else {
310293d7fbdSSimon Glass 					bg_idx = (*tip_buffer) / blk_per_grp;
311293d7fbdSSimon Glass 
312293d7fbdSSimon Glass 					remainder = (*tip_buffer) % blk_per_grp;
313293d7fbdSSimon Glass 					if (!remainder)
314293d7fbdSSimon Glass 						bg_idx--;
315293d7fbdSSimon Glass 				}
316293d7fbdSSimon Glass 
317293d7fbdSSimon Glass 				ext4fs_reset_block_bmap(*tip_buffer,
318293d7fbdSSimon Glass 							fs->blk_bmaps[bg_idx],
319293d7fbdSSimon Glass 							bg_idx);
320293d7fbdSSimon Glass 
321293d7fbdSSimon Glass 				tip_buffer++;
322293d7fbdSSimon Glass 				bgd[bg_idx].free_blocks++;
323293d7fbdSSimon Glass 				fs->sb->free_blocks++;
324293d7fbdSSimon Glass 				/* journal backup */
325293d7fbdSSimon Glass 				if (prev_bg_bmap_idx != bg_idx) {
326293d7fbdSSimon Glass 					status =
327293d7fbdSSimon Glass 					    ext4fs_devread(
328293d7fbdSSimon Glass 							bgd[bg_idx].block_id *
329293d7fbdSSimon Glass 							fs->sect_perblk, 0,
330293d7fbdSSimon Glass 							fs->blksz,
331293d7fbdSSimon Glass 							journal_buffer);
332293d7fbdSSimon Glass 					if (status == 0)
333293d7fbdSSimon Glass 						goto fail;
334293d7fbdSSimon Glass 
335293d7fbdSSimon Glass 					if (ext4fs_log_journal(journal_buffer,
336293d7fbdSSimon Glass 							       bgd[bg_idx].
337293d7fbdSSimon Glass 							       block_id))
338293d7fbdSSimon Glass 						goto fail;
339293d7fbdSSimon Glass 					prev_bg_bmap_idx = bg_idx;
340293d7fbdSSimon Glass 				}
341293d7fbdSSimon Glass 			}
342293d7fbdSSimon Glass 			free(tipb_start_addr);
343293d7fbdSSimon Glass 			tipb_start_addr = NULL;
344293d7fbdSSimon Glass 
345293d7fbdSSimon Glass 			/*
346293d7fbdSSimon Glass 			 * removing the grand parent blocks
347293d7fbdSSimon Glass 			 * which is connected to inode
348293d7fbdSSimon Glass 			 */
349293d7fbdSSimon Glass 			if (fs->blksz != 1024) {
350293d7fbdSSimon Glass 				bg_idx = (*tigp_buffer) / blk_per_grp;
351293d7fbdSSimon Glass 			} else {
352293d7fbdSSimon Glass 				bg_idx = (*tigp_buffer) / blk_per_grp;
353293d7fbdSSimon Glass 
354293d7fbdSSimon Glass 				remainder = (*tigp_buffer) % blk_per_grp;
355293d7fbdSSimon Glass 				if (!remainder)
356293d7fbdSSimon Glass 					bg_idx--;
357293d7fbdSSimon Glass 			}
358293d7fbdSSimon Glass 			ext4fs_reset_block_bmap(*tigp_buffer,
359293d7fbdSSimon Glass 						fs->blk_bmaps[bg_idx], bg_idx);
360293d7fbdSSimon Glass 
361293d7fbdSSimon Glass 			tigp_buffer++;
362293d7fbdSSimon Glass 			bgd[bg_idx].free_blocks++;
363293d7fbdSSimon Glass 			fs->sb->free_blocks++;
364293d7fbdSSimon Glass 			/* journal backup */
365293d7fbdSSimon Glass 			if (prev_bg_bmap_idx != bg_idx) {
366293d7fbdSSimon Glass 				memset(journal_buffer, '\0', fs->blksz);
367293d7fbdSSimon Glass 				status =
368293d7fbdSSimon Glass 				    ext4fs_devread(bgd[bg_idx].block_id *
369293d7fbdSSimon Glass 						   fs->sect_perblk, 0,
370293d7fbdSSimon Glass 						   fs->blksz, journal_buffer);
371293d7fbdSSimon Glass 				if (status == 0)
372293d7fbdSSimon Glass 					goto fail;
373293d7fbdSSimon Glass 
374293d7fbdSSimon Glass 				if (ext4fs_log_journal(journal_buffer,
375293d7fbdSSimon Glass 							bgd[bg_idx].block_id))
376293d7fbdSSimon Glass 					goto fail;
377293d7fbdSSimon Glass 				prev_bg_bmap_idx = bg_idx;
378293d7fbdSSimon Glass 			}
379293d7fbdSSimon Glass 		}
380293d7fbdSSimon Glass 
381293d7fbdSSimon Glass 		/* removing the grand parent triple indirect block */
382293d7fbdSSimon Glass 		blknr = inode->b.blocks.triple_indir_block;
383293d7fbdSSimon Glass 		if (fs->blksz != 1024) {
384293d7fbdSSimon Glass 			bg_idx = blknr / blk_per_grp;
385293d7fbdSSimon Glass 		} else {
386293d7fbdSSimon Glass 			bg_idx = blknr / blk_per_grp;
387293d7fbdSSimon Glass 			remainder = blknr % blk_per_grp;
388293d7fbdSSimon Glass 			if (!remainder)
389293d7fbdSSimon Glass 				bg_idx--;
390293d7fbdSSimon Glass 		}
391293d7fbdSSimon Glass 		ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx);
392293d7fbdSSimon Glass 		bgd[bg_idx].free_blocks++;
393293d7fbdSSimon Glass 		fs->sb->free_blocks++;
394293d7fbdSSimon Glass 		/* journal backup */
395293d7fbdSSimon Glass 		if (prev_bg_bmap_idx != bg_idx) {
396293d7fbdSSimon Glass 			memset(journal_buffer, '\0', fs->blksz);
397293d7fbdSSimon Glass 			status = ext4fs_devread(bgd[bg_idx].block_id *
398293d7fbdSSimon Glass 						fs->sect_perblk, 0, fs->blksz,
399293d7fbdSSimon Glass 						journal_buffer);
400293d7fbdSSimon Glass 			if (status == 0)
401293d7fbdSSimon Glass 				goto fail;
402293d7fbdSSimon Glass 
403293d7fbdSSimon Glass 			if (ext4fs_log_journal(journal_buffer,
404293d7fbdSSimon Glass 						bgd[bg_idx].block_id))
405293d7fbdSSimon Glass 				goto fail;
406293d7fbdSSimon Glass 			prev_bg_bmap_idx = bg_idx;
407293d7fbdSSimon Glass 		}
408293d7fbdSSimon Glass 		debug("tigp buffer itself releasing %ld\n", blknr);
409293d7fbdSSimon Glass 	}
410293d7fbdSSimon Glass fail:
411293d7fbdSSimon Glass 	free(tib_start_addr);
412293d7fbdSSimon Glass 	free(tipb_start_addr);
413293d7fbdSSimon Glass 	free(journal_buffer);
414293d7fbdSSimon Glass }
415293d7fbdSSimon Glass 
416293d7fbdSSimon Glass static int ext4fs_delete_file(int inodeno)
417293d7fbdSSimon Glass {
418293d7fbdSSimon Glass 	struct ext2_inode inode;
419293d7fbdSSimon Glass 	short status;
420293d7fbdSSimon Glass 	int i;
421293d7fbdSSimon Glass 	int remainder;
422293d7fbdSSimon Glass 	long int blknr;
423293d7fbdSSimon Glass 	int bg_idx;
424293d7fbdSSimon Glass 	int ibmap_idx;
425293d7fbdSSimon Glass 	char *read_buffer = NULL;
426293d7fbdSSimon Glass 	char *start_block_address = NULL;
427293d7fbdSSimon Glass 	unsigned int no_blocks;
428293d7fbdSSimon Glass 
429293d7fbdSSimon Glass 	static int prev_bg_bmap_idx = -1;
430293d7fbdSSimon Glass 	unsigned int inodes_per_block;
431293d7fbdSSimon Glass 	long int blkno;
432293d7fbdSSimon Glass 	unsigned int blkoff;
433293d7fbdSSimon Glass 	unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group;
434293d7fbdSSimon Glass 	unsigned int inode_per_grp = ext4fs_root->sblock.inodes_per_group;
435293d7fbdSSimon Glass 	struct ext2_inode *inode_buffer = NULL;
436293d7fbdSSimon Glass 	struct ext2_block_group *bgd = NULL;
437293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
438293d7fbdSSimon Glass 	char *journal_buffer = zalloc(fs->blksz);
439293d7fbdSSimon Glass 	if (!journal_buffer)
440293d7fbdSSimon Glass 		return -ENOMEM;
441293d7fbdSSimon Glass 	/* get the block group descriptor table */
442293d7fbdSSimon Glass 	bgd = (struct ext2_block_group *)fs->gdtable;
443293d7fbdSSimon Glass 	status = ext4fs_read_inode(ext4fs_root, inodeno, &inode);
444293d7fbdSSimon Glass 	if (status == 0)
445293d7fbdSSimon Glass 		goto fail;
446293d7fbdSSimon Glass 
447293d7fbdSSimon Glass 	/* read the block no allocated to a file */
448293d7fbdSSimon Glass 	no_blocks = inode.size / fs->blksz;
449293d7fbdSSimon Glass 	if (inode.size % fs->blksz)
450293d7fbdSSimon Glass 		no_blocks++;
451293d7fbdSSimon Glass 
452293d7fbdSSimon Glass 	if (le32_to_cpu(inode.flags) & EXT4_EXTENTS_FL) {
453293d7fbdSSimon Glass 		struct ext2fs_node *node_inode =
454293d7fbdSSimon Glass 		    zalloc(sizeof(struct ext2fs_node));
455293d7fbdSSimon Glass 		if (!node_inode)
456293d7fbdSSimon Glass 			goto fail;
457293d7fbdSSimon Glass 		node_inode->data = ext4fs_root;
458293d7fbdSSimon Glass 		node_inode->ino = inodeno;
459293d7fbdSSimon Glass 		node_inode->inode_read = 0;
460293d7fbdSSimon Glass 		memcpy(&(node_inode->inode), &inode, sizeof(struct ext2_inode));
461293d7fbdSSimon Glass 
462293d7fbdSSimon Glass 		for (i = 0; i < no_blocks; i++) {
463293d7fbdSSimon Glass 			blknr = read_allocated_block(&(node_inode->inode), i);
464293d7fbdSSimon Glass 			if (fs->blksz != 1024) {
465293d7fbdSSimon Glass 				bg_idx = blknr / blk_per_grp;
466293d7fbdSSimon Glass 			} else {
467293d7fbdSSimon Glass 				bg_idx = blknr / blk_per_grp;
468293d7fbdSSimon Glass 				remainder = blknr % blk_per_grp;
469293d7fbdSSimon Glass 				if (!remainder)
470293d7fbdSSimon Glass 					bg_idx--;
471293d7fbdSSimon Glass 			}
472293d7fbdSSimon Glass 			ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx],
473293d7fbdSSimon Glass 						bg_idx);
474293d7fbdSSimon Glass 			debug("EXT4_EXTENTS Block releasing %ld: %d\n",
475293d7fbdSSimon Glass 			      blknr, bg_idx);
476293d7fbdSSimon Glass 
477293d7fbdSSimon Glass 			bgd[bg_idx].free_blocks++;
478293d7fbdSSimon Glass 			fs->sb->free_blocks++;
479293d7fbdSSimon Glass 
480293d7fbdSSimon Glass 			/* journal backup */
481293d7fbdSSimon Glass 			if (prev_bg_bmap_idx != bg_idx) {
482293d7fbdSSimon Glass 				status =
483293d7fbdSSimon Glass 				    ext4fs_devread(bgd[bg_idx].block_id *
484293d7fbdSSimon Glass 						   fs->sect_perblk, 0,
485293d7fbdSSimon Glass 						   fs->blksz, journal_buffer);
486293d7fbdSSimon Glass 				if (status == 0)
487293d7fbdSSimon Glass 					goto fail;
488293d7fbdSSimon Glass 				if (ext4fs_log_journal(journal_buffer,
489293d7fbdSSimon Glass 							bgd[bg_idx].block_id))
490293d7fbdSSimon Glass 					goto fail;
491293d7fbdSSimon Glass 				prev_bg_bmap_idx = bg_idx;
492293d7fbdSSimon Glass 			}
493293d7fbdSSimon Glass 		}
494293d7fbdSSimon Glass 		if (node_inode) {
495293d7fbdSSimon Glass 			free(node_inode);
496293d7fbdSSimon Glass 			node_inode = NULL;
497293d7fbdSSimon Glass 		}
498293d7fbdSSimon Glass 	} else {
499293d7fbdSSimon Glass 
500293d7fbdSSimon Glass 		delete_single_indirect_block(&inode);
501293d7fbdSSimon Glass 		delete_double_indirect_block(&inode);
502293d7fbdSSimon Glass 		delete_triple_indirect_block(&inode);
503293d7fbdSSimon Glass 
504293d7fbdSSimon Glass 		/* read the block no allocated to a file */
505293d7fbdSSimon Glass 		no_blocks = inode.size / fs->blksz;
506293d7fbdSSimon Glass 		if (inode.size % fs->blksz)
507293d7fbdSSimon Glass 			no_blocks++;
508293d7fbdSSimon Glass 		for (i = 0; i < no_blocks; i++) {
509293d7fbdSSimon Glass 			blknr = read_allocated_block(&inode, i);
510293d7fbdSSimon Glass 			if (fs->blksz != 1024) {
511293d7fbdSSimon Glass 				bg_idx = blknr / blk_per_grp;
512293d7fbdSSimon Glass 			} else {
513293d7fbdSSimon Glass 				bg_idx = blknr / blk_per_grp;
514293d7fbdSSimon Glass 				remainder = blknr % blk_per_grp;
515293d7fbdSSimon Glass 				if (!remainder)
516293d7fbdSSimon Glass 					bg_idx--;
517293d7fbdSSimon Glass 			}
518293d7fbdSSimon Glass 			ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx],
519293d7fbdSSimon Glass 						bg_idx);
520293d7fbdSSimon Glass 			debug("ActualB releasing %ld: %d\n", blknr, bg_idx);
521293d7fbdSSimon Glass 
522293d7fbdSSimon Glass 			bgd[bg_idx].free_blocks++;
523293d7fbdSSimon Glass 			fs->sb->free_blocks++;
524293d7fbdSSimon Glass 			/* journal backup */
525293d7fbdSSimon Glass 			if (prev_bg_bmap_idx != bg_idx) {
526293d7fbdSSimon Glass 				memset(journal_buffer, '\0', fs->blksz);
527293d7fbdSSimon Glass 				status = ext4fs_devread(bgd[bg_idx].block_id
528293d7fbdSSimon Glass 							* fs->sect_perblk,
529293d7fbdSSimon Glass 							0, fs->blksz,
530293d7fbdSSimon Glass 							journal_buffer);
531293d7fbdSSimon Glass 				if (status == 0)
532293d7fbdSSimon Glass 					goto fail;
533293d7fbdSSimon Glass 				if (ext4fs_log_journal(journal_buffer,
534293d7fbdSSimon Glass 						bgd[bg_idx].block_id))
535293d7fbdSSimon Glass 					goto fail;
536293d7fbdSSimon Glass 				prev_bg_bmap_idx = bg_idx;
537293d7fbdSSimon Glass 			}
538293d7fbdSSimon Glass 		}
539293d7fbdSSimon Glass 	}
540293d7fbdSSimon Glass 
541293d7fbdSSimon Glass 	/* from the inode no to blockno */
542293d7fbdSSimon Glass 	inodes_per_block = fs->blksz / fs->inodesz;
543293d7fbdSSimon Glass 	ibmap_idx = inodeno / inode_per_grp;
544293d7fbdSSimon Glass 
545293d7fbdSSimon Glass 	/* get the block no */
546293d7fbdSSimon Glass 	inodeno--;
547293d7fbdSSimon Glass 	blkno = __le32_to_cpu(bgd[ibmap_idx].inode_table_id) +
548293d7fbdSSimon Glass 		(inodeno % __le32_to_cpu(inode_per_grp)) / inodes_per_block;
549293d7fbdSSimon Glass 
550293d7fbdSSimon Glass 	/* get the offset of the inode */
551293d7fbdSSimon Glass 	blkoff = ((inodeno) % inodes_per_block) * fs->inodesz;
552293d7fbdSSimon Glass 
553293d7fbdSSimon Glass 	/* read the block no containing the inode */
554293d7fbdSSimon Glass 	read_buffer = zalloc(fs->blksz);
555293d7fbdSSimon Glass 	if (!read_buffer)
556293d7fbdSSimon Glass 		goto fail;
557293d7fbdSSimon Glass 	start_block_address = read_buffer;
558293d7fbdSSimon Glass 	status = ext4fs_devread(blkno * fs->sect_perblk,
559293d7fbdSSimon Glass 				0, fs->blksz, read_buffer);
560293d7fbdSSimon Glass 	if (status == 0)
561293d7fbdSSimon Glass 		goto fail;
562293d7fbdSSimon Glass 
563293d7fbdSSimon Glass 	if (ext4fs_log_journal(read_buffer, blkno))
564293d7fbdSSimon Glass 		goto fail;
565293d7fbdSSimon Glass 
566293d7fbdSSimon Glass 	read_buffer = read_buffer + blkoff;
567293d7fbdSSimon Glass 	inode_buffer = (struct ext2_inode *)read_buffer;
568293d7fbdSSimon Glass 	memset(inode_buffer, '\0', sizeof(struct ext2_inode));
569293d7fbdSSimon Glass 
570293d7fbdSSimon Glass 	/* write the inode to original position in inode table */
571293d7fbdSSimon Glass 	if (ext4fs_put_metadata(start_block_address, blkno))
572293d7fbdSSimon Glass 		goto fail;
573293d7fbdSSimon Glass 
574293d7fbdSSimon Glass 	/* update the respective inode bitmaps */
575293d7fbdSSimon Glass 	inodeno++;
576293d7fbdSSimon Glass 	ext4fs_reset_inode_bmap(inodeno, fs->inode_bmaps[ibmap_idx], ibmap_idx);
577293d7fbdSSimon Glass 	bgd[ibmap_idx].free_inodes++;
578293d7fbdSSimon Glass 	fs->sb->free_inodes++;
579293d7fbdSSimon Glass 	/* journal backup */
580293d7fbdSSimon Glass 	memset(journal_buffer, '\0', fs->blksz);
581293d7fbdSSimon Glass 	status = ext4fs_devread(bgd[ibmap_idx].inode_id *
582293d7fbdSSimon Glass 				fs->sect_perblk, 0, fs->blksz, journal_buffer);
583293d7fbdSSimon Glass 	if (status == 0)
584293d7fbdSSimon Glass 		goto fail;
585293d7fbdSSimon Glass 	if (ext4fs_log_journal(journal_buffer, bgd[ibmap_idx].inode_id))
586293d7fbdSSimon Glass 		goto fail;
587293d7fbdSSimon Glass 
588293d7fbdSSimon Glass 	ext4fs_update();
589293d7fbdSSimon Glass 	ext4fs_deinit();
590293d7fbdSSimon Glass 
591293d7fbdSSimon Glass 	if (ext4fs_init() != 0) {
592293d7fbdSSimon Glass 		printf("error in File System init\n");
593293d7fbdSSimon Glass 		goto fail;
594293d7fbdSSimon Glass 	}
595293d7fbdSSimon Glass 
596293d7fbdSSimon Glass 	free(start_block_address);
597293d7fbdSSimon Glass 	free(journal_buffer);
598293d7fbdSSimon Glass 
599293d7fbdSSimon Glass 	return 0;
600293d7fbdSSimon Glass fail:
601293d7fbdSSimon Glass 	free(start_block_address);
602293d7fbdSSimon Glass 	free(journal_buffer);
603293d7fbdSSimon Glass 
604293d7fbdSSimon Glass 	return -1;
605293d7fbdSSimon Glass }
606293d7fbdSSimon Glass 
607293d7fbdSSimon Glass int ext4fs_init(void)
608293d7fbdSSimon Glass {
609293d7fbdSSimon Glass 	short status;
610293d7fbdSSimon Glass 	int i;
611293d7fbdSSimon Glass 	unsigned int real_free_blocks = 0;
612293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
613293d7fbdSSimon Glass 
614293d7fbdSSimon Glass 	/* populate fs */
615293d7fbdSSimon Glass 	fs->blksz = EXT2_BLOCK_SIZE(ext4fs_root);
616293d7fbdSSimon Glass 	fs->inodesz = INODE_SIZE_FILESYSTEM(ext4fs_root);
617*50ce4c07SEgbert Eich 	fs->sect_perblk = fs->blksz >> fs->dev_desc->log2blksz;
618293d7fbdSSimon Glass 
619293d7fbdSSimon Glass 	/* get the superblock */
620293d7fbdSSimon Glass 	fs->sb = zalloc(SUPERBLOCK_SIZE);
621293d7fbdSSimon Glass 	if (!fs->sb)
622293d7fbdSSimon Glass 		return -ENOMEM;
623*50ce4c07SEgbert Eich 	if (!ext4_read_superblock((char *)fs->sb))
624293d7fbdSSimon Glass 		goto fail;
625293d7fbdSSimon Glass 
626293d7fbdSSimon Glass 	/* init journal */
627293d7fbdSSimon Glass 	if (ext4fs_init_journal())
628293d7fbdSSimon Glass 		goto fail;
629293d7fbdSSimon Glass 
630293d7fbdSSimon Glass 	/* get total no of blockgroups */
631293d7fbdSSimon Glass 	fs->no_blkgrp = (uint32_t)ext4fs_div_roundup(
632293d7fbdSSimon Glass 			(ext4fs_root->sblock.total_blocks -
633293d7fbdSSimon Glass 			ext4fs_root->sblock.first_data_block),
634293d7fbdSSimon Glass 			ext4fs_root->sblock.blocks_per_group);
635293d7fbdSSimon Glass 
636293d7fbdSSimon Glass 	/* get the block group descriptor table */
637293d7fbdSSimon Glass 	fs->gdtable_blkno = ((EXT2_MIN_BLOCK_SIZE == fs->blksz) + 1);
638293d7fbdSSimon Glass 	if (ext4fs_get_bgdtable() == -1) {
639293d7fbdSSimon Glass 		printf("Error in getting the block group descriptor table\n");
640293d7fbdSSimon Glass 		goto fail;
641293d7fbdSSimon Glass 	}
642293d7fbdSSimon Glass 	fs->bgd = (struct ext2_block_group *)fs->gdtable;
643293d7fbdSSimon Glass 
644293d7fbdSSimon Glass 	/* load all the available bitmap block of the partition */
645293d7fbdSSimon Glass 	fs->blk_bmaps = zalloc(fs->no_blkgrp * sizeof(char *));
646293d7fbdSSimon Glass 	if (!fs->blk_bmaps)
647293d7fbdSSimon Glass 		goto fail;
648293d7fbdSSimon Glass 	for (i = 0; i < fs->no_blkgrp; i++) {
649293d7fbdSSimon Glass 		fs->blk_bmaps[i] = zalloc(fs->blksz);
650293d7fbdSSimon Glass 		if (!fs->blk_bmaps[i])
651293d7fbdSSimon Glass 			goto fail;
652293d7fbdSSimon Glass 	}
653293d7fbdSSimon Glass 
654293d7fbdSSimon Glass 	for (i = 0; i < fs->no_blkgrp; i++) {
655293d7fbdSSimon Glass 		status =
656293d7fbdSSimon Glass 		    ext4fs_devread(fs->bgd[i].block_id * fs->sect_perblk, 0,
657293d7fbdSSimon Glass 				   fs->blksz, (char *)fs->blk_bmaps[i]);
658293d7fbdSSimon Glass 		if (status == 0)
659293d7fbdSSimon Glass 			goto fail;
660293d7fbdSSimon Glass 	}
661293d7fbdSSimon Glass 
662293d7fbdSSimon Glass 	/* load all the available inode bitmap of the partition */
663293d7fbdSSimon Glass 	fs->inode_bmaps = zalloc(fs->no_blkgrp * sizeof(unsigned char *));
664293d7fbdSSimon Glass 	if (!fs->inode_bmaps)
665293d7fbdSSimon Glass 		goto fail;
666293d7fbdSSimon Glass 	for (i = 0; i < fs->no_blkgrp; i++) {
667293d7fbdSSimon Glass 		fs->inode_bmaps[i] = zalloc(fs->blksz);
668293d7fbdSSimon Glass 		if (!fs->inode_bmaps[i])
669293d7fbdSSimon Glass 			goto fail;
670293d7fbdSSimon Glass 	}
671293d7fbdSSimon Glass 
672293d7fbdSSimon Glass 	for (i = 0; i < fs->no_blkgrp; i++) {
673293d7fbdSSimon Glass 		status = ext4fs_devread(fs->bgd[i].inode_id * fs->sect_perblk,
674293d7fbdSSimon Glass 					0, fs->blksz,
675293d7fbdSSimon Glass 					(char *)fs->inode_bmaps[i]);
676293d7fbdSSimon Glass 		if (status == 0)
677293d7fbdSSimon Glass 			goto fail;
678293d7fbdSSimon Glass 	}
679293d7fbdSSimon Glass 
680293d7fbdSSimon Glass 	/*
681293d7fbdSSimon Glass 	 * check filesystem consistency with free blocks of file system
682293d7fbdSSimon Glass 	 * some time we observed that superblock freeblocks does not match
683293d7fbdSSimon Glass 	 * with the  blockgroups freeblocks when improper
684293d7fbdSSimon Glass 	 * reboot of a linux kernel
685293d7fbdSSimon Glass 	 */
686293d7fbdSSimon Glass 	for (i = 0; i < fs->no_blkgrp; i++)
687293d7fbdSSimon Glass 		real_free_blocks = real_free_blocks + fs->bgd[i].free_blocks;
688293d7fbdSSimon Glass 	if (real_free_blocks != fs->sb->free_blocks)
689293d7fbdSSimon Glass 		fs->sb->free_blocks = real_free_blocks;
690293d7fbdSSimon Glass 
691293d7fbdSSimon Glass 	return 0;
692293d7fbdSSimon Glass fail:
693293d7fbdSSimon Glass 	ext4fs_deinit();
694293d7fbdSSimon Glass 
695293d7fbdSSimon Glass 	return -1;
696293d7fbdSSimon Glass }
697293d7fbdSSimon Glass 
698293d7fbdSSimon Glass void ext4fs_deinit(void)
699293d7fbdSSimon Glass {
700293d7fbdSSimon Glass 	int i;
701293d7fbdSSimon Glass 	struct ext2_inode inode_journal;
702293d7fbdSSimon Glass 	struct journal_superblock_t *jsb;
703293d7fbdSSimon Glass 	long int blknr;
704293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
705293d7fbdSSimon Glass 
706293d7fbdSSimon Glass 	/* free journal */
707293d7fbdSSimon Glass 	char *temp_buff = zalloc(fs->blksz);
708293d7fbdSSimon Glass 	if (temp_buff) {
709293d7fbdSSimon Glass 		ext4fs_read_inode(ext4fs_root, EXT2_JOURNAL_INO,
710293d7fbdSSimon Glass 				  &inode_journal);
711293d7fbdSSimon Glass 		blknr = read_allocated_block(&inode_journal,
712293d7fbdSSimon Glass 					EXT2_JOURNAL_SUPERBLOCK);
713293d7fbdSSimon Glass 		ext4fs_devread(blknr * fs->sect_perblk, 0, fs->blksz,
714293d7fbdSSimon Glass 			       temp_buff);
715293d7fbdSSimon Glass 		jsb = (struct journal_superblock_t *)temp_buff;
716293d7fbdSSimon Glass 		jsb->s_start = cpu_to_be32(0);
717293d7fbdSSimon Glass 		put_ext4((uint64_t) (blknr * fs->blksz),
718293d7fbdSSimon Glass 			 (struct journal_superblock_t *)temp_buff, fs->blksz);
719293d7fbdSSimon Glass 		free(temp_buff);
720293d7fbdSSimon Glass 	}
721293d7fbdSSimon Glass 	ext4fs_free_journal();
722293d7fbdSSimon Glass 
723293d7fbdSSimon Glass 	/* get the superblock */
724*50ce4c07SEgbert Eich 	ext4_read_superblock((char *)fs->sb);
725293d7fbdSSimon Glass 	fs->sb->feature_incompat &= ~EXT3_FEATURE_INCOMPAT_RECOVER;
726293d7fbdSSimon Glass 	put_ext4((uint64_t)(SUPERBLOCK_SIZE),
727293d7fbdSSimon Glass 		 (struct ext2_sblock *)fs->sb, (uint32_t)SUPERBLOCK_SIZE);
728293d7fbdSSimon Glass 	free(fs->sb);
729293d7fbdSSimon Glass 	fs->sb = NULL;
730293d7fbdSSimon Glass 
731293d7fbdSSimon Glass 	if (fs->blk_bmaps) {
732293d7fbdSSimon Glass 		for (i = 0; i < fs->no_blkgrp; i++) {
733293d7fbdSSimon Glass 			free(fs->blk_bmaps[i]);
734293d7fbdSSimon Glass 			fs->blk_bmaps[i] = NULL;
735293d7fbdSSimon Glass 		}
736293d7fbdSSimon Glass 		free(fs->blk_bmaps);
737293d7fbdSSimon Glass 		fs->blk_bmaps = NULL;
738293d7fbdSSimon Glass 	}
739293d7fbdSSimon Glass 
740293d7fbdSSimon Glass 	if (fs->inode_bmaps) {
741293d7fbdSSimon Glass 		for (i = 0; i < fs->no_blkgrp; i++) {
742293d7fbdSSimon Glass 			free(fs->inode_bmaps[i]);
743293d7fbdSSimon Glass 			fs->inode_bmaps[i] = NULL;
744293d7fbdSSimon Glass 		}
745293d7fbdSSimon Glass 		free(fs->inode_bmaps);
746293d7fbdSSimon Glass 		fs->inode_bmaps = NULL;
747293d7fbdSSimon Glass 	}
748293d7fbdSSimon Glass 
749293d7fbdSSimon Glass 
750293d7fbdSSimon Glass 	free(fs->gdtable);
751293d7fbdSSimon Glass 	fs->gdtable = NULL;
752293d7fbdSSimon Glass 	fs->bgd = NULL;
753293d7fbdSSimon Glass 	/*
754293d7fbdSSimon Glass 	 * reinitiliazed the global inode and
755293d7fbdSSimon Glass 	 * block bitmap first execution check variables
756293d7fbdSSimon Glass 	 */
757293d7fbdSSimon Glass 	fs->first_pass_ibmap = 0;
758293d7fbdSSimon Glass 	fs->first_pass_bbmap = 0;
759293d7fbdSSimon Glass 	fs->curr_inode_no = 0;
760293d7fbdSSimon Glass 	fs->curr_blkno = 0;
761293d7fbdSSimon Glass }
762293d7fbdSSimon Glass 
763293d7fbdSSimon Glass static int ext4fs_write_file(struct ext2_inode *file_inode,
764293d7fbdSSimon Glass 			     int pos, unsigned int len, char *buf)
765293d7fbdSSimon Glass {
766293d7fbdSSimon Glass 	int i;
767293d7fbdSSimon Glass 	int blockcnt;
768293d7fbdSSimon Glass 	unsigned int filesize = __le32_to_cpu(file_inode->size);
769293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
770*50ce4c07SEgbert Eich 	int log2blksz = fs->dev_desc->log2blksz;
771*50ce4c07SEgbert Eich 	int log2_fs_blocksize = LOG2_BLOCK_SIZE(ext4fs_root) - log2blksz;
772293d7fbdSSimon Glass 	int previous_block_number = -1;
773293d7fbdSSimon Glass 	int delayed_start = 0;
774293d7fbdSSimon Glass 	int delayed_extent = 0;
775293d7fbdSSimon Glass 	int delayed_next = 0;
776293d7fbdSSimon Glass 	char *delayed_buf = NULL;
777293d7fbdSSimon Glass 
778293d7fbdSSimon Glass 	/* Adjust len so it we can't read past the end of the file. */
779293d7fbdSSimon Glass 	if (len > filesize)
780293d7fbdSSimon Glass 		len = filesize;
781293d7fbdSSimon Glass 
782293d7fbdSSimon Glass 	blockcnt = ((len + pos) + fs->blksz - 1) / fs->blksz;
783293d7fbdSSimon Glass 
784293d7fbdSSimon Glass 	for (i = pos / fs->blksz; i < blockcnt; i++) {
785293d7fbdSSimon Glass 		long int blknr;
786293d7fbdSSimon Glass 		int blockend = fs->blksz;
787293d7fbdSSimon Glass 		int skipfirst = 0;
788293d7fbdSSimon Glass 		blknr = read_allocated_block(file_inode, i);
789293d7fbdSSimon Glass 		if (blknr < 0)
790293d7fbdSSimon Glass 			return -1;
791293d7fbdSSimon Glass 
792*50ce4c07SEgbert Eich 		blknr = blknr << log2_fs_blocksize;
793293d7fbdSSimon Glass 
794293d7fbdSSimon Glass 		if (blknr) {
795293d7fbdSSimon Glass 			if (previous_block_number != -1) {
796293d7fbdSSimon Glass 				if (delayed_next == blknr) {
797293d7fbdSSimon Glass 					delayed_extent += blockend;
798*50ce4c07SEgbert Eich 					delayed_next += blockend >> log2blksz;
799293d7fbdSSimon Glass 				} else {	/* spill */
800*50ce4c07SEgbert Eich 					put_ext4((uint64_t)
801*50ce4c07SEgbert Eich 						 (delayed_start << log2blksz),
802293d7fbdSSimon Glass 						 delayed_buf,
803293d7fbdSSimon Glass 						 (uint32_t) delayed_extent);
804293d7fbdSSimon Glass 					previous_block_number = blknr;
805293d7fbdSSimon Glass 					delayed_start = blknr;
806293d7fbdSSimon Glass 					delayed_extent = blockend;
807293d7fbdSSimon Glass 					delayed_buf = buf;
808293d7fbdSSimon Glass 					delayed_next = blknr +
809*50ce4c07SEgbert Eich 					    (blockend >> log2blksz);
810293d7fbdSSimon Glass 				}
811293d7fbdSSimon Glass 			} else {
812293d7fbdSSimon Glass 				previous_block_number = blknr;
813293d7fbdSSimon Glass 				delayed_start = blknr;
814293d7fbdSSimon Glass 				delayed_extent = blockend;
815293d7fbdSSimon Glass 				delayed_buf = buf;
816293d7fbdSSimon Glass 				delayed_next = blknr +
817*50ce4c07SEgbert Eich 				    (blockend >> log2blksz);
818293d7fbdSSimon Glass 			}
819293d7fbdSSimon Glass 		} else {
820293d7fbdSSimon Glass 			if (previous_block_number != -1) {
821293d7fbdSSimon Glass 				/* spill */
822*50ce4c07SEgbert Eich 				put_ext4((uint64_t) (delayed_start <<
823*50ce4c07SEgbert Eich 						     log2blksz),
824*50ce4c07SEgbert Eich 					 delayed_buf,
825293d7fbdSSimon Glass 					 (uint32_t) delayed_extent);
826293d7fbdSSimon Glass 				previous_block_number = -1;
827293d7fbdSSimon Glass 			}
828293d7fbdSSimon Glass 			memset(buf, 0, fs->blksz - skipfirst);
829293d7fbdSSimon Glass 		}
830293d7fbdSSimon Glass 		buf += fs->blksz - skipfirst;
831293d7fbdSSimon Glass 	}
832293d7fbdSSimon Glass 	if (previous_block_number != -1) {
833293d7fbdSSimon Glass 		/* spill */
834*50ce4c07SEgbert Eich 		put_ext4((uint64_t) (delayed_start << log2blksz),
835293d7fbdSSimon Glass 			 delayed_buf, (uint32_t) delayed_extent);
836293d7fbdSSimon Glass 		previous_block_number = -1;
837293d7fbdSSimon Glass 	}
838293d7fbdSSimon Glass 
839293d7fbdSSimon Glass 	return len;
840293d7fbdSSimon Glass }
841293d7fbdSSimon Glass 
842293d7fbdSSimon Glass int ext4fs_write(const char *fname, unsigned char *buffer,
843293d7fbdSSimon Glass 					unsigned long sizebytes)
844293d7fbdSSimon Glass {
845293d7fbdSSimon Glass 	int ret = 0;
846293d7fbdSSimon Glass 	struct ext2_inode *file_inode = NULL;
847293d7fbdSSimon Glass 	unsigned char *inode_buffer = NULL;
848293d7fbdSSimon Glass 	int parent_inodeno;
849293d7fbdSSimon Glass 	int inodeno;
850293d7fbdSSimon Glass 	time_t timestamp = 0;
851293d7fbdSSimon Glass 
852293d7fbdSSimon Glass 	uint64_t bytes_reqd_for_file;
853293d7fbdSSimon Glass 	unsigned int blks_reqd_for_file;
854293d7fbdSSimon Glass 	unsigned int blocks_remaining;
855293d7fbdSSimon Glass 	int existing_file_inodeno;
856293d7fbdSSimon Glass 	char *temp_ptr = NULL;
857293d7fbdSSimon Glass 	long int itable_blkno;
858293d7fbdSSimon Glass 	long int parent_itable_blkno;
859293d7fbdSSimon Glass 	long int blkoff;
860293d7fbdSSimon Glass 	struct ext2_sblock *sblock = &(ext4fs_root->sblock);
861293d7fbdSSimon Glass 	unsigned int inodes_per_block;
862293d7fbdSSimon Glass 	unsigned int ibmap_idx;
863293d7fbdSSimon Glass 	struct ext_filesystem *fs = get_fs();
864293d7fbdSSimon Glass 	ALLOC_CACHE_ALIGN_BUFFER(char, filename, 256);
865293d7fbdSSimon Glass 	memset(filename, 0x00, sizeof(filename));
866293d7fbdSSimon Glass 
867293d7fbdSSimon Glass 	g_parent_inode = zalloc(sizeof(struct ext2_inode));
868293d7fbdSSimon Glass 	if (!g_parent_inode)
869293d7fbdSSimon Glass 		goto fail;
870293d7fbdSSimon Glass 
871293d7fbdSSimon Glass 	if (ext4fs_init() != 0) {
872293d7fbdSSimon Glass 		printf("error in File System init\n");
873293d7fbdSSimon Glass 		return -1;
874293d7fbdSSimon Glass 	}
875293d7fbdSSimon Glass 	inodes_per_block = fs->blksz / fs->inodesz;
876293d7fbdSSimon Glass 	parent_inodeno = ext4fs_get_parent_inode_num(fname, filename, F_FILE);
877293d7fbdSSimon Glass 	if (parent_inodeno == -1)
878293d7fbdSSimon Glass 		goto fail;
879293d7fbdSSimon Glass 	if (ext4fs_iget(parent_inodeno, g_parent_inode))
880293d7fbdSSimon Glass 		goto fail;
881293d7fbdSSimon Glass 	/* check if the filename is already present in root */
882293d7fbdSSimon Glass 	existing_file_inodeno = ext4fs_filename_check(filename);
883293d7fbdSSimon Glass 	if (existing_file_inodeno != -1) {
884293d7fbdSSimon Glass 		ret = ext4fs_delete_file(existing_file_inodeno);
885293d7fbdSSimon Glass 		fs->first_pass_bbmap = 0;
886293d7fbdSSimon Glass 		fs->curr_blkno = 0;
887293d7fbdSSimon Glass 
888293d7fbdSSimon Glass 		fs->first_pass_ibmap = 0;
889293d7fbdSSimon Glass 		fs->curr_inode_no = 0;
890293d7fbdSSimon Glass 		if (ret)
891293d7fbdSSimon Glass 			goto fail;
892293d7fbdSSimon Glass 	}
893293d7fbdSSimon Glass 	/* calucalate how many blocks required */
894293d7fbdSSimon Glass 	bytes_reqd_for_file = sizebytes;
895293d7fbdSSimon Glass 	blks_reqd_for_file = lldiv(bytes_reqd_for_file, fs->blksz);
896293d7fbdSSimon Glass 	if (do_div(bytes_reqd_for_file, fs->blksz) != 0) {
897293d7fbdSSimon Glass 		blks_reqd_for_file++;
898293d7fbdSSimon Glass 		debug("total bytes for a file %u\n", blks_reqd_for_file);
899293d7fbdSSimon Glass 	}
900293d7fbdSSimon Glass 	blocks_remaining = blks_reqd_for_file;
901293d7fbdSSimon Glass 	/* test for available space in partition */
902293d7fbdSSimon Glass 	if (fs->sb->free_blocks < blks_reqd_for_file) {
903293d7fbdSSimon Glass 		printf("Not enough space on partition !!!\n");
904293d7fbdSSimon Glass 		goto fail;
905293d7fbdSSimon Glass 	}
906293d7fbdSSimon Glass 
907293d7fbdSSimon Glass 	ext4fs_update_parent_dentry(filename, &inodeno, FILETYPE_REG);
908293d7fbdSSimon Glass 	/* prepare file inode */
909293d7fbdSSimon Glass 	inode_buffer = zalloc(fs->inodesz);
910293d7fbdSSimon Glass 	if (!inode_buffer)
911293d7fbdSSimon Glass 		goto fail;
912293d7fbdSSimon Glass 	file_inode = (struct ext2_inode *)inode_buffer;
913293d7fbdSSimon Glass 	file_inode->mode = S_IFREG | S_IRWXU |
914293d7fbdSSimon Glass 	    S_IRGRP | S_IROTH | S_IXGRP | S_IXOTH;
915293d7fbdSSimon Glass 	/* ToDo: Update correct time */
916293d7fbdSSimon Glass 	file_inode->mtime = timestamp;
917293d7fbdSSimon Glass 	file_inode->atime = timestamp;
918293d7fbdSSimon Glass 	file_inode->ctime = timestamp;
919293d7fbdSSimon Glass 	file_inode->nlinks = 1;
920293d7fbdSSimon Glass 	file_inode->size = sizebytes;
921293d7fbdSSimon Glass 
922293d7fbdSSimon Glass 	/* Allocate data blocks */
923293d7fbdSSimon Glass 	ext4fs_allocate_blocks(file_inode, blocks_remaining,
924293d7fbdSSimon Glass 			       &blks_reqd_for_file);
925*50ce4c07SEgbert Eich 	file_inode->blockcnt = (blks_reqd_for_file * fs->blksz) >>
926*50ce4c07SEgbert Eich 		fs->dev_desc->log2blksz;
927293d7fbdSSimon Glass 
928293d7fbdSSimon Glass 	temp_ptr = zalloc(fs->blksz);
929293d7fbdSSimon Glass 	if (!temp_ptr)
930293d7fbdSSimon Glass 		goto fail;
931293d7fbdSSimon Glass 	ibmap_idx = inodeno / ext4fs_root->sblock.inodes_per_group;
932293d7fbdSSimon Glass 	inodeno--;
933293d7fbdSSimon Glass 	itable_blkno = __le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) +
934293d7fbdSSimon Glass 			(inodeno % __le32_to_cpu(sblock->inodes_per_group)) /
935293d7fbdSSimon Glass 			inodes_per_block;
936293d7fbdSSimon Glass 	blkoff = (inodeno % inodes_per_block) * fs->inodesz;
937293d7fbdSSimon Glass 	ext4fs_devread(itable_blkno * fs->sect_perblk, 0, fs->blksz, temp_ptr);
938293d7fbdSSimon Glass 	if (ext4fs_log_journal(temp_ptr, itable_blkno))
939293d7fbdSSimon Glass 		goto fail;
940293d7fbdSSimon Glass 
941293d7fbdSSimon Glass 	memcpy(temp_ptr + blkoff, inode_buffer, fs->inodesz);
942293d7fbdSSimon Glass 	if (ext4fs_put_metadata(temp_ptr, itable_blkno))
943293d7fbdSSimon Glass 		goto fail;
944293d7fbdSSimon Glass 	/* copy the file content into data blocks */
945293d7fbdSSimon Glass 	if (ext4fs_write_file(file_inode, 0, sizebytes, (char *)buffer) == -1) {
946293d7fbdSSimon Glass 		printf("Error in copying content\n");
947293d7fbdSSimon Glass 		goto fail;
948293d7fbdSSimon Glass 	}
949293d7fbdSSimon Glass 	ibmap_idx = parent_inodeno / ext4fs_root->sblock.inodes_per_group;
950293d7fbdSSimon Glass 	parent_inodeno--;
951293d7fbdSSimon Glass 	parent_itable_blkno = __le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) +
952293d7fbdSSimon Glass 	    (parent_inodeno %
953293d7fbdSSimon Glass 	     __le32_to_cpu(sblock->inodes_per_group)) / inodes_per_block;
954293d7fbdSSimon Glass 	blkoff = (parent_inodeno % inodes_per_block) * fs->inodesz;
955293d7fbdSSimon Glass 	if (parent_itable_blkno != itable_blkno) {
956293d7fbdSSimon Glass 		memset(temp_ptr, '\0', fs->blksz);
957293d7fbdSSimon Glass 		ext4fs_devread(parent_itable_blkno * fs->sect_perblk,
958293d7fbdSSimon Glass 			       0, fs->blksz, temp_ptr);
959293d7fbdSSimon Glass 		if (ext4fs_log_journal(temp_ptr, parent_itable_blkno))
960293d7fbdSSimon Glass 			goto fail;
961293d7fbdSSimon Glass 
962293d7fbdSSimon Glass 		memcpy(temp_ptr + blkoff, g_parent_inode,
963293d7fbdSSimon Glass 			sizeof(struct ext2_inode));
964293d7fbdSSimon Glass 		if (ext4fs_put_metadata(temp_ptr, parent_itable_blkno))
965293d7fbdSSimon Glass 			goto fail;
966293d7fbdSSimon Glass 		free(temp_ptr);
967293d7fbdSSimon Glass 	} else {
968293d7fbdSSimon Glass 		/*
969293d7fbdSSimon Glass 		 * If parent and child fall in same inode table block
970293d7fbdSSimon Glass 		 * both should be kept in 1 buffer
971293d7fbdSSimon Glass 		 */
972293d7fbdSSimon Glass 		memcpy(temp_ptr + blkoff, g_parent_inode,
973293d7fbdSSimon Glass 		       sizeof(struct ext2_inode));
974293d7fbdSSimon Glass 		gd_index--;
975293d7fbdSSimon Glass 		if (ext4fs_put_metadata(temp_ptr, itable_blkno))
976293d7fbdSSimon Glass 			goto fail;
977293d7fbdSSimon Glass 		free(temp_ptr);
978293d7fbdSSimon Glass 	}
979293d7fbdSSimon Glass 	ext4fs_update();
980293d7fbdSSimon Glass 	ext4fs_deinit();
981293d7fbdSSimon Glass 
982293d7fbdSSimon Glass 	fs->first_pass_bbmap = 0;
983293d7fbdSSimon Glass 	fs->curr_blkno = 0;
984293d7fbdSSimon Glass 	fs->first_pass_ibmap = 0;
985293d7fbdSSimon Glass 	fs->curr_inode_no = 0;
986293d7fbdSSimon Glass 	free(inode_buffer);
987293d7fbdSSimon Glass 	free(g_parent_inode);
988293d7fbdSSimon Glass 	g_parent_inode = NULL;
989293d7fbdSSimon Glass 
990293d7fbdSSimon Glass 	return 0;
991293d7fbdSSimon Glass fail:
992293d7fbdSSimon Glass 	ext4fs_deinit();
993293d7fbdSSimon Glass 	free(inode_buffer);
994293d7fbdSSimon Glass 	free(g_parent_inode);
995293d7fbdSSimon Glass 	g_parent_inode = NULL;
996293d7fbdSSimon Glass 
997293d7fbdSSimon Glass 	return -1;
998293d7fbdSSimon Glass }
999