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 */ 91*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)fs->gdtable_blkno * fs->sect_perblk, 92*04735e9cSFrederic Leroy 0, 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 = 145*04735e9cSFrederic Leroy ext4fs_devread((lbaint_t)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; 189*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, 190*04735e9cSFrederic Leroy fs->blksz, (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) { 211*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t) 212*04735e9cSFrederic Leroy bgd[bg_idx].block_id 213293d7fbdSSimon Glass * fs->sect_perblk, 0, 214293d7fbdSSimon Glass fs->blksz, 215293d7fbdSSimon Glass journal_buffer); 216293d7fbdSSimon Glass if (status == 0) 217293d7fbdSSimon Glass goto fail; 218293d7fbdSSimon Glass 219293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 220293d7fbdSSimon Glass bgd[bg_idx].block_id)) 221293d7fbdSSimon Glass goto fail; 222293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 223293d7fbdSSimon Glass } 224293d7fbdSSimon Glass } 225293d7fbdSSimon Glass 226293d7fbdSSimon Glass /* removing the parent double indirect block */ 227293d7fbdSSimon Glass blknr = inode->b.blocks.double_indir_block; 228293d7fbdSSimon Glass if (fs->blksz != 1024) { 229293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 230293d7fbdSSimon Glass } else { 231293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 232293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 233293d7fbdSSimon Glass if (!remainder) 234293d7fbdSSimon Glass bg_idx--; 235293d7fbdSSimon Glass } 236293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx); 237293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 238293d7fbdSSimon Glass fs->sb->free_blocks++; 239293d7fbdSSimon Glass /* journal backup */ 240293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 241293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 242*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)bgd[bg_idx].block_id * 243293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 244293d7fbdSSimon Glass journal_buffer); 245293d7fbdSSimon Glass if (status == 0) 246293d7fbdSSimon Glass goto fail; 247293d7fbdSSimon Glass 248293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 249293d7fbdSSimon Glass bgd[bg_idx].block_id)) 250293d7fbdSSimon Glass goto fail; 251293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 252293d7fbdSSimon Glass } 253293d7fbdSSimon Glass debug("DIPB releasing %ld\n", blknr); 254293d7fbdSSimon Glass } 255293d7fbdSSimon Glass fail: 256293d7fbdSSimon Glass free(DIB_start_addr); 257293d7fbdSSimon Glass free(journal_buffer); 258293d7fbdSSimon Glass } 259293d7fbdSSimon Glass 260293d7fbdSSimon Glass static void delete_triple_indirect_block(struct ext2_inode *inode) 261293d7fbdSSimon Glass { 262293d7fbdSSimon Glass int i, j; 263293d7fbdSSimon Glass short status; 264293d7fbdSSimon Glass static int prev_bg_bmap_idx = -1; 265293d7fbdSSimon Glass long int blknr; 266293d7fbdSSimon Glass int remainder; 267293d7fbdSSimon Glass int bg_idx; 268293d7fbdSSimon Glass unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group; 269293d7fbdSSimon Glass unsigned int *tigp_buffer = NULL; 270293d7fbdSSimon Glass unsigned int *tib_start_addr = NULL; 271293d7fbdSSimon Glass unsigned int *tip_buffer = NULL; 272293d7fbdSSimon Glass unsigned int *tipb_start_addr = NULL; 273293d7fbdSSimon Glass struct ext2_block_group *bgd = NULL; 274293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 275293d7fbdSSimon Glass char *journal_buffer = zalloc(fs->blksz); 276293d7fbdSSimon Glass if (!journal_buffer) { 277293d7fbdSSimon Glass printf("No memory\n"); 278293d7fbdSSimon Glass return; 279293d7fbdSSimon Glass } 280293d7fbdSSimon Glass /* get block group descriptor table */ 281293d7fbdSSimon Glass bgd = (struct ext2_block_group *)fs->gdtable; 282293d7fbdSSimon Glass 283293d7fbdSSimon Glass if (inode->b.blocks.triple_indir_block != 0) { 284293d7fbdSSimon Glass tigp_buffer = zalloc(fs->blksz); 285293d7fbdSSimon Glass if (!tigp_buffer) { 286293d7fbdSSimon Glass printf("No memory\n"); 287293d7fbdSSimon Glass return; 288293d7fbdSSimon Glass } 289293d7fbdSSimon Glass tib_start_addr = (unsigned int *)tigp_buffer; 290293d7fbdSSimon Glass blknr = inode->b.blocks.triple_indir_block; 291*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, 292*04735e9cSFrederic Leroy fs->blksz, (char *)tigp_buffer); 293293d7fbdSSimon Glass for (i = 0; i < fs->blksz / sizeof(int); i++) { 294293d7fbdSSimon Glass if (*tigp_buffer == 0) 295293d7fbdSSimon Glass break; 296293d7fbdSSimon Glass debug("tigp buffer releasing %u\n", *tigp_buffer); 297293d7fbdSSimon Glass 298293d7fbdSSimon Glass tip_buffer = zalloc(fs->blksz); 299293d7fbdSSimon Glass if (!tip_buffer) 300293d7fbdSSimon Glass goto fail; 301293d7fbdSSimon Glass tipb_start_addr = (unsigned int *)tip_buffer; 302*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)(*tigp_buffer) * 303293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 304293d7fbdSSimon Glass (char *)tip_buffer); 305293d7fbdSSimon Glass for (j = 0; j < fs->blksz / sizeof(int); j++) { 306293d7fbdSSimon Glass if (*tip_buffer == 0) 307293d7fbdSSimon Glass break; 308293d7fbdSSimon Glass if (fs->blksz != 1024) { 309293d7fbdSSimon Glass bg_idx = (*tip_buffer) / blk_per_grp; 310293d7fbdSSimon Glass } else { 311293d7fbdSSimon Glass bg_idx = (*tip_buffer) / blk_per_grp; 312293d7fbdSSimon Glass 313293d7fbdSSimon Glass remainder = (*tip_buffer) % blk_per_grp; 314293d7fbdSSimon Glass if (!remainder) 315293d7fbdSSimon Glass bg_idx--; 316293d7fbdSSimon Glass } 317293d7fbdSSimon Glass 318293d7fbdSSimon Glass ext4fs_reset_block_bmap(*tip_buffer, 319293d7fbdSSimon Glass fs->blk_bmaps[bg_idx], 320293d7fbdSSimon Glass bg_idx); 321293d7fbdSSimon Glass 322293d7fbdSSimon Glass tip_buffer++; 323293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 324293d7fbdSSimon Glass fs->sb->free_blocks++; 325293d7fbdSSimon Glass /* journal backup */ 326293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 327293d7fbdSSimon Glass status = 328293d7fbdSSimon Glass ext4fs_devread( 329*04735e9cSFrederic Leroy (lbaint_t) 330293d7fbdSSimon Glass bgd[bg_idx].block_id * 331293d7fbdSSimon Glass fs->sect_perblk, 0, 332293d7fbdSSimon Glass fs->blksz, 333293d7fbdSSimon Glass journal_buffer); 334293d7fbdSSimon Glass if (status == 0) 335293d7fbdSSimon Glass goto fail; 336293d7fbdSSimon Glass 337293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 338293d7fbdSSimon Glass bgd[bg_idx]. 339293d7fbdSSimon Glass block_id)) 340293d7fbdSSimon Glass goto fail; 341293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 342293d7fbdSSimon Glass } 343293d7fbdSSimon Glass } 344293d7fbdSSimon Glass free(tipb_start_addr); 345293d7fbdSSimon Glass tipb_start_addr = NULL; 346293d7fbdSSimon Glass 347293d7fbdSSimon Glass /* 348293d7fbdSSimon Glass * removing the grand parent blocks 349293d7fbdSSimon Glass * which is connected to inode 350293d7fbdSSimon Glass */ 351293d7fbdSSimon Glass if (fs->blksz != 1024) { 352293d7fbdSSimon Glass bg_idx = (*tigp_buffer) / blk_per_grp; 353293d7fbdSSimon Glass } else { 354293d7fbdSSimon Glass bg_idx = (*tigp_buffer) / blk_per_grp; 355293d7fbdSSimon Glass 356293d7fbdSSimon Glass remainder = (*tigp_buffer) % blk_per_grp; 357293d7fbdSSimon Glass if (!remainder) 358293d7fbdSSimon Glass bg_idx--; 359293d7fbdSSimon Glass } 360293d7fbdSSimon Glass ext4fs_reset_block_bmap(*tigp_buffer, 361293d7fbdSSimon Glass fs->blk_bmaps[bg_idx], bg_idx); 362293d7fbdSSimon Glass 363293d7fbdSSimon Glass tigp_buffer++; 364293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 365293d7fbdSSimon Glass fs->sb->free_blocks++; 366293d7fbdSSimon Glass /* journal backup */ 367293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 368293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 369293d7fbdSSimon Glass status = 370*04735e9cSFrederic Leroy ext4fs_devread((lbaint_t) 371*04735e9cSFrederic Leroy bgd[bg_idx].block_id * 372293d7fbdSSimon Glass fs->sect_perblk, 0, 373293d7fbdSSimon Glass fs->blksz, journal_buffer); 374293d7fbdSSimon Glass if (status == 0) 375293d7fbdSSimon Glass goto fail; 376293d7fbdSSimon Glass 377293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 378293d7fbdSSimon Glass bgd[bg_idx].block_id)) 379293d7fbdSSimon Glass goto fail; 380293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 381293d7fbdSSimon Glass } 382293d7fbdSSimon Glass } 383293d7fbdSSimon Glass 384293d7fbdSSimon Glass /* removing the grand parent triple indirect block */ 385293d7fbdSSimon Glass blknr = inode->b.blocks.triple_indir_block; 386293d7fbdSSimon Glass if (fs->blksz != 1024) { 387293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 388293d7fbdSSimon Glass } else { 389293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 390293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 391293d7fbdSSimon Glass if (!remainder) 392293d7fbdSSimon Glass bg_idx--; 393293d7fbdSSimon Glass } 394293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx); 395293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 396293d7fbdSSimon Glass fs->sb->free_blocks++; 397293d7fbdSSimon Glass /* journal backup */ 398293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 399293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 400*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)bgd[bg_idx].block_id * 401293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 402293d7fbdSSimon Glass journal_buffer); 403293d7fbdSSimon Glass if (status == 0) 404293d7fbdSSimon Glass goto fail; 405293d7fbdSSimon Glass 406293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 407293d7fbdSSimon Glass bgd[bg_idx].block_id)) 408293d7fbdSSimon Glass goto fail; 409293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 410293d7fbdSSimon Glass } 411293d7fbdSSimon Glass debug("tigp buffer itself releasing %ld\n", blknr); 412293d7fbdSSimon Glass } 413293d7fbdSSimon Glass fail: 414293d7fbdSSimon Glass free(tib_start_addr); 415293d7fbdSSimon Glass free(tipb_start_addr); 416293d7fbdSSimon Glass free(journal_buffer); 417293d7fbdSSimon Glass } 418293d7fbdSSimon Glass 419293d7fbdSSimon Glass static int ext4fs_delete_file(int inodeno) 420293d7fbdSSimon Glass { 421293d7fbdSSimon Glass struct ext2_inode inode; 422293d7fbdSSimon Glass short status; 423293d7fbdSSimon Glass int i; 424293d7fbdSSimon Glass int remainder; 425293d7fbdSSimon Glass long int blknr; 426293d7fbdSSimon Glass int bg_idx; 427293d7fbdSSimon Glass int ibmap_idx; 428293d7fbdSSimon Glass char *read_buffer = NULL; 429293d7fbdSSimon Glass char *start_block_address = NULL; 430293d7fbdSSimon Glass unsigned int no_blocks; 431293d7fbdSSimon Glass 432293d7fbdSSimon Glass static int prev_bg_bmap_idx = -1; 433293d7fbdSSimon Glass unsigned int inodes_per_block; 434293d7fbdSSimon Glass long int blkno; 435293d7fbdSSimon Glass unsigned int blkoff; 436293d7fbdSSimon Glass unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group; 437293d7fbdSSimon Glass unsigned int inode_per_grp = ext4fs_root->sblock.inodes_per_group; 438293d7fbdSSimon Glass struct ext2_inode *inode_buffer = NULL; 439293d7fbdSSimon Glass struct ext2_block_group *bgd = NULL; 440293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 441293d7fbdSSimon Glass char *journal_buffer = zalloc(fs->blksz); 442293d7fbdSSimon Glass if (!journal_buffer) 443293d7fbdSSimon Glass return -ENOMEM; 444293d7fbdSSimon Glass /* get the block group descriptor table */ 445293d7fbdSSimon Glass bgd = (struct ext2_block_group *)fs->gdtable; 446293d7fbdSSimon Glass status = ext4fs_read_inode(ext4fs_root, inodeno, &inode); 447293d7fbdSSimon Glass if (status == 0) 448293d7fbdSSimon Glass goto fail; 449293d7fbdSSimon Glass 450293d7fbdSSimon Glass /* read the block no allocated to a file */ 451293d7fbdSSimon Glass no_blocks = inode.size / fs->blksz; 452293d7fbdSSimon Glass if (inode.size % fs->blksz) 453293d7fbdSSimon Glass no_blocks++; 454293d7fbdSSimon Glass 455293d7fbdSSimon Glass if (le32_to_cpu(inode.flags) & EXT4_EXTENTS_FL) { 456293d7fbdSSimon Glass struct ext2fs_node *node_inode = 457293d7fbdSSimon Glass zalloc(sizeof(struct ext2fs_node)); 458293d7fbdSSimon Glass if (!node_inode) 459293d7fbdSSimon Glass goto fail; 460293d7fbdSSimon Glass node_inode->data = ext4fs_root; 461293d7fbdSSimon Glass node_inode->ino = inodeno; 462293d7fbdSSimon Glass node_inode->inode_read = 0; 463293d7fbdSSimon Glass memcpy(&(node_inode->inode), &inode, sizeof(struct ext2_inode)); 464293d7fbdSSimon Glass 465293d7fbdSSimon Glass for (i = 0; i < no_blocks; i++) { 466293d7fbdSSimon Glass blknr = read_allocated_block(&(node_inode->inode), i); 467293d7fbdSSimon Glass if (fs->blksz != 1024) { 468293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 469293d7fbdSSimon Glass } else { 470293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 471293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 472293d7fbdSSimon Glass if (!remainder) 473293d7fbdSSimon Glass bg_idx--; 474293d7fbdSSimon Glass } 475293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], 476293d7fbdSSimon Glass bg_idx); 477293d7fbdSSimon Glass debug("EXT4_EXTENTS Block releasing %ld: %d\n", 478293d7fbdSSimon Glass blknr, bg_idx); 479293d7fbdSSimon Glass 480293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 481293d7fbdSSimon Glass fs->sb->free_blocks++; 482293d7fbdSSimon Glass 483293d7fbdSSimon Glass /* journal backup */ 484293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 485293d7fbdSSimon Glass status = 486*04735e9cSFrederic Leroy ext4fs_devread((lbaint_t) 487*04735e9cSFrederic Leroy bgd[bg_idx].block_id * 488293d7fbdSSimon Glass fs->sect_perblk, 0, 489293d7fbdSSimon Glass fs->blksz, journal_buffer); 490293d7fbdSSimon Glass if (status == 0) 491293d7fbdSSimon Glass goto fail; 492293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 493293d7fbdSSimon Glass bgd[bg_idx].block_id)) 494293d7fbdSSimon Glass goto fail; 495293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 496293d7fbdSSimon Glass } 497293d7fbdSSimon Glass } 498293d7fbdSSimon Glass if (node_inode) { 499293d7fbdSSimon Glass free(node_inode); 500293d7fbdSSimon Glass node_inode = NULL; 501293d7fbdSSimon Glass } 502293d7fbdSSimon Glass } else { 503293d7fbdSSimon Glass 504293d7fbdSSimon Glass delete_single_indirect_block(&inode); 505293d7fbdSSimon Glass delete_double_indirect_block(&inode); 506293d7fbdSSimon Glass delete_triple_indirect_block(&inode); 507293d7fbdSSimon Glass 508293d7fbdSSimon Glass /* read the block no allocated to a file */ 509293d7fbdSSimon Glass no_blocks = inode.size / fs->blksz; 510293d7fbdSSimon Glass if (inode.size % fs->blksz) 511293d7fbdSSimon Glass no_blocks++; 512293d7fbdSSimon Glass for (i = 0; i < no_blocks; i++) { 513293d7fbdSSimon Glass blknr = read_allocated_block(&inode, i); 514293d7fbdSSimon Glass if (fs->blksz != 1024) { 515293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 516293d7fbdSSimon Glass } else { 517293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 518293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 519293d7fbdSSimon Glass if (!remainder) 520293d7fbdSSimon Glass bg_idx--; 521293d7fbdSSimon Glass } 522293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], 523293d7fbdSSimon Glass bg_idx); 524293d7fbdSSimon Glass debug("ActualB releasing %ld: %d\n", blknr, bg_idx); 525293d7fbdSSimon Glass 526293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 527293d7fbdSSimon Glass fs->sb->free_blocks++; 528293d7fbdSSimon Glass /* journal backup */ 529293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 530293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 531*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t) 532*04735e9cSFrederic Leroy bgd[bg_idx].block_id 533293d7fbdSSimon Glass * fs->sect_perblk, 534293d7fbdSSimon Glass 0, fs->blksz, 535293d7fbdSSimon Glass journal_buffer); 536293d7fbdSSimon Glass if (status == 0) 537293d7fbdSSimon Glass goto fail; 538293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 539293d7fbdSSimon Glass bgd[bg_idx].block_id)) 540293d7fbdSSimon Glass goto fail; 541293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 542293d7fbdSSimon Glass } 543293d7fbdSSimon Glass } 544293d7fbdSSimon Glass } 545293d7fbdSSimon Glass 546293d7fbdSSimon Glass /* from the inode no to blockno */ 547293d7fbdSSimon Glass inodes_per_block = fs->blksz / fs->inodesz; 548293d7fbdSSimon Glass ibmap_idx = inodeno / inode_per_grp; 549293d7fbdSSimon Glass 550293d7fbdSSimon Glass /* get the block no */ 551293d7fbdSSimon Glass inodeno--; 552293d7fbdSSimon Glass blkno = __le32_to_cpu(bgd[ibmap_idx].inode_table_id) + 553293d7fbdSSimon Glass (inodeno % __le32_to_cpu(inode_per_grp)) / inodes_per_block; 554293d7fbdSSimon Glass 555293d7fbdSSimon Glass /* get the offset of the inode */ 556293d7fbdSSimon Glass blkoff = ((inodeno) % inodes_per_block) * fs->inodesz; 557293d7fbdSSimon Glass 558293d7fbdSSimon Glass /* read the block no containing the inode */ 559293d7fbdSSimon Glass read_buffer = zalloc(fs->blksz); 560293d7fbdSSimon Glass if (!read_buffer) 561293d7fbdSSimon Glass goto fail; 562293d7fbdSSimon Glass start_block_address = read_buffer; 563*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)blkno * fs->sect_perblk, 564293d7fbdSSimon Glass 0, fs->blksz, read_buffer); 565293d7fbdSSimon Glass if (status == 0) 566293d7fbdSSimon Glass goto fail; 567293d7fbdSSimon Glass 568293d7fbdSSimon Glass if (ext4fs_log_journal(read_buffer, blkno)) 569293d7fbdSSimon Glass goto fail; 570293d7fbdSSimon Glass 571293d7fbdSSimon Glass read_buffer = read_buffer + blkoff; 572293d7fbdSSimon Glass inode_buffer = (struct ext2_inode *)read_buffer; 573293d7fbdSSimon Glass memset(inode_buffer, '\0', sizeof(struct ext2_inode)); 574293d7fbdSSimon Glass 575293d7fbdSSimon Glass /* write the inode to original position in inode table */ 576293d7fbdSSimon Glass if (ext4fs_put_metadata(start_block_address, blkno)) 577293d7fbdSSimon Glass goto fail; 578293d7fbdSSimon Glass 579293d7fbdSSimon Glass /* update the respective inode bitmaps */ 580293d7fbdSSimon Glass inodeno++; 581293d7fbdSSimon Glass ext4fs_reset_inode_bmap(inodeno, fs->inode_bmaps[ibmap_idx], ibmap_idx); 582293d7fbdSSimon Glass bgd[ibmap_idx].free_inodes++; 583293d7fbdSSimon Glass fs->sb->free_inodes++; 584293d7fbdSSimon Glass /* journal backup */ 585293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 586*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)bgd[ibmap_idx].inode_id * 587293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, journal_buffer); 588293d7fbdSSimon Glass if (status == 0) 589293d7fbdSSimon Glass goto fail; 590293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, bgd[ibmap_idx].inode_id)) 591293d7fbdSSimon Glass goto fail; 592293d7fbdSSimon Glass 593293d7fbdSSimon Glass ext4fs_update(); 594293d7fbdSSimon Glass ext4fs_deinit(); 595293d7fbdSSimon Glass 596293d7fbdSSimon Glass if (ext4fs_init() != 0) { 597293d7fbdSSimon Glass printf("error in File System init\n"); 598293d7fbdSSimon Glass goto fail; 599293d7fbdSSimon Glass } 600293d7fbdSSimon Glass 601293d7fbdSSimon Glass free(start_block_address); 602293d7fbdSSimon Glass free(journal_buffer); 603293d7fbdSSimon Glass 604293d7fbdSSimon Glass return 0; 605293d7fbdSSimon Glass fail: 606293d7fbdSSimon Glass free(start_block_address); 607293d7fbdSSimon Glass free(journal_buffer); 608293d7fbdSSimon Glass 609293d7fbdSSimon Glass return -1; 610293d7fbdSSimon Glass } 611293d7fbdSSimon Glass 612293d7fbdSSimon Glass int ext4fs_init(void) 613293d7fbdSSimon Glass { 614293d7fbdSSimon Glass short status; 615293d7fbdSSimon Glass int i; 616293d7fbdSSimon Glass unsigned int real_free_blocks = 0; 617293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 618293d7fbdSSimon Glass 619293d7fbdSSimon Glass /* populate fs */ 620293d7fbdSSimon Glass fs->blksz = EXT2_BLOCK_SIZE(ext4fs_root); 621293d7fbdSSimon Glass fs->inodesz = INODE_SIZE_FILESYSTEM(ext4fs_root); 62250ce4c07SEgbert Eich fs->sect_perblk = fs->blksz >> fs->dev_desc->log2blksz; 623293d7fbdSSimon Glass 624293d7fbdSSimon Glass /* get the superblock */ 625293d7fbdSSimon Glass fs->sb = zalloc(SUPERBLOCK_SIZE); 626293d7fbdSSimon Glass if (!fs->sb) 627293d7fbdSSimon Glass return -ENOMEM; 62850ce4c07SEgbert Eich if (!ext4_read_superblock((char *)fs->sb)) 629293d7fbdSSimon Glass goto fail; 630293d7fbdSSimon Glass 631293d7fbdSSimon Glass /* init journal */ 632293d7fbdSSimon Glass if (ext4fs_init_journal()) 633293d7fbdSSimon Glass goto fail; 634293d7fbdSSimon Glass 635293d7fbdSSimon Glass /* get total no of blockgroups */ 636293d7fbdSSimon Glass fs->no_blkgrp = (uint32_t)ext4fs_div_roundup( 637293d7fbdSSimon Glass (ext4fs_root->sblock.total_blocks - 638293d7fbdSSimon Glass ext4fs_root->sblock.first_data_block), 639293d7fbdSSimon Glass ext4fs_root->sblock.blocks_per_group); 640293d7fbdSSimon Glass 641293d7fbdSSimon Glass /* get the block group descriptor table */ 642293d7fbdSSimon Glass fs->gdtable_blkno = ((EXT2_MIN_BLOCK_SIZE == fs->blksz) + 1); 643293d7fbdSSimon Glass if (ext4fs_get_bgdtable() == -1) { 644293d7fbdSSimon Glass printf("Error in getting the block group descriptor table\n"); 645293d7fbdSSimon Glass goto fail; 646293d7fbdSSimon Glass } 647293d7fbdSSimon Glass fs->bgd = (struct ext2_block_group *)fs->gdtable; 648293d7fbdSSimon Glass 649293d7fbdSSimon Glass /* load all the available bitmap block of the partition */ 650293d7fbdSSimon Glass fs->blk_bmaps = zalloc(fs->no_blkgrp * sizeof(char *)); 651293d7fbdSSimon Glass if (!fs->blk_bmaps) 652293d7fbdSSimon Glass goto fail; 653293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 654293d7fbdSSimon Glass fs->blk_bmaps[i] = zalloc(fs->blksz); 655293d7fbdSSimon Glass if (!fs->blk_bmaps[i]) 656293d7fbdSSimon Glass goto fail; 657293d7fbdSSimon Glass } 658293d7fbdSSimon Glass 659293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 660293d7fbdSSimon Glass status = 661*04735e9cSFrederic Leroy ext4fs_devread((lbaint_t)fs->bgd[i].block_id * 662*04735e9cSFrederic Leroy fs->sect_perblk, 0, 663293d7fbdSSimon Glass fs->blksz, (char *)fs->blk_bmaps[i]); 664293d7fbdSSimon Glass if (status == 0) 665293d7fbdSSimon Glass goto fail; 666293d7fbdSSimon Glass } 667293d7fbdSSimon Glass 668293d7fbdSSimon Glass /* load all the available inode bitmap of the partition */ 669293d7fbdSSimon Glass fs->inode_bmaps = zalloc(fs->no_blkgrp * sizeof(unsigned char *)); 670293d7fbdSSimon Glass if (!fs->inode_bmaps) 671293d7fbdSSimon Glass goto fail; 672293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 673293d7fbdSSimon Glass fs->inode_bmaps[i] = zalloc(fs->blksz); 674293d7fbdSSimon Glass if (!fs->inode_bmaps[i]) 675293d7fbdSSimon Glass goto fail; 676293d7fbdSSimon Glass } 677293d7fbdSSimon Glass 678293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 679*04735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)fs->bgd[i].inode_id * 680*04735e9cSFrederic Leroy fs->sect_perblk, 681293d7fbdSSimon Glass 0, fs->blksz, 682293d7fbdSSimon Glass (char *)fs->inode_bmaps[i]); 683293d7fbdSSimon Glass if (status == 0) 684293d7fbdSSimon Glass goto fail; 685293d7fbdSSimon Glass } 686293d7fbdSSimon Glass 687293d7fbdSSimon Glass /* 688293d7fbdSSimon Glass * check filesystem consistency with free blocks of file system 689293d7fbdSSimon Glass * some time we observed that superblock freeblocks does not match 690293d7fbdSSimon Glass * with the blockgroups freeblocks when improper 691293d7fbdSSimon Glass * reboot of a linux kernel 692293d7fbdSSimon Glass */ 693293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) 694293d7fbdSSimon Glass real_free_blocks = real_free_blocks + fs->bgd[i].free_blocks; 695293d7fbdSSimon Glass if (real_free_blocks != fs->sb->free_blocks) 696293d7fbdSSimon Glass fs->sb->free_blocks = real_free_blocks; 697293d7fbdSSimon Glass 698293d7fbdSSimon Glass return 0; 699293d7fbdSSimon Glass fail: 700293d7fbdSSimon Glass ext4fs_deinit(); 701293d7fbdSSimon Glass 702293d7fbdSSimon Glass return -1; 703293d7fbdSSimon Glass } 704293d7fbdSSimon Glass 705293d7fbdSSimon Glass void ext4fs_deinit(void) 706293d7fbdSSimon Glass { 707293d7fbdSSimon Glass int i; 708293d7fbdSSimon Glass struct ext2_inode inode_journal; 709293d7fbdSSimon Glass struct journal_superblock_t *jsb; 710293d7fbdSSimon Glass long int blknr; 711293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 712293d7fbdSSimon Glass 713293d7fbdSSimon Glass /* free journal */ 714293d7fbdSSimon Glass char *temp_buff = zalloc(fs->blksz); 715293d7fbdSSimon Glass if (temp_buff) { 716293d7fbdSSimon Glass ext4fs_read_inode(ext4fs_root, EXT2_JOURNAL_INO, 717293d7fbdSSimon Glass &inode_journal); 718293d7fbdSSimon Glass blknr = read_allocated_block(&inode_journal, 719293d7fbdSSimon Glass EXT2_JOURNAL_SUPERBLOCK); 720*04735e9cSFrederic Leroy ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, fs->blksz, 721293d7fbdSSimon Glass temp_buff); 722293d7fbdSSimon Glass jsb = (struct journal_superblock_t *)temp_buff; 723293d7fbdSSimon Glass jsb->s_start = cpu_to_be32(0); 724293d7fbdSSimon Glass put_ext4((uint64_t) (blknr * fs->blksz), 725293d7fbdSSimon Glass (struct journal_superblock_t *)temp_buff, fs->blksz); 726293d7fbdSSimon Glass free(temp_buff); 727293d7fbdSSimon Glass } 728293d7fbdSSimon Glass ext4fs_free_journal(); 729293d7fbdSSimon Glass 730293d7fbdSSimon Glass /* get the superblock */ 73150ce4c07SEgbert Eich ext4_read_superblock((char *)fs->sb); 732293d7fbdSSimon Glass fs->sb->feature_incompat &= ~EXT3_FEATURE_INCOMPAT_RECOVER; 733293d7fbdSSimon Glass put_ext4((uint64_t)(SUPERBLOCK_SIZE), 734293d7fbdSSimon Glass (struct ext2_sblock *)fs->sb, (uint32_t)SUPERBLOCK_SIZE); 735293d7fbdSSimon Glass free(fs->sb); 736293d7fbdSSimon Glass fs->sb = NULL; 737293d7fbdSSimon Glass 738293d7fbdSSimon Glass if (fs->blk_bmaps) { 739293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 740293d7fbdSSimon Glass free(fs->blk_bmaps[i]); 741293d7fbdSSimon Glass fs->blk_bmaps[i] = NULL; 742293d7fbdSSimon Glass } 743293d7fbdSSimon Glass free(fs->blk_bmaps); 744293d7fbdSSimon Glass fs->blk_bmaps = NULL; 745293d7fbdSSimon Glass } 746293d7fbdSSimon Glass 747293d7fbdSSimon Glass if (fs->inode_bmaps) { 748293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 749293d7fbdSSimon Glass free(fs->inode_bmaps[i]); 750293d7fbdSSimon Glass fs->inode_bmaps[i] = NULL; 751293d7fbdSSimon Glass } 752293d7fbdSSimon Glass free(fs->inode_bmaps); 753293d7fbdSSimon Glass fs->inode_bmaps = NULL; 754293d7fbdSSimon Glass } 755293d7fbdSSimon Glass 756293d7fbdSSimon Glass 757293d7fbdSSimon Glass free(fs->gdtable); 758293d7fbdSSimon Glass fs->gdtable = NULL; 759293d7fbdSSimon Glass fs->bgd = NULL; 760293d7fbdSSimon Glass /* 761293d7fbdSSimon Glass * reinitiliazed the global inode and 762293d7fbdSSimon Glass * block bitmap first execution check variables 763293d7fbdSSimon Glass */ 764293d7fbdSSimon Glass fs->first_pass_ibmap = 0; 765293d7fbdSSimon Glass fs->first_pass_bbmap = 0; 766293d7fbdSSimon Glass fs->curr_inode_no = 0; 767293d7fbdSSimon Glass fs->curr_blkno = 0; 768293d7fbdSSimon Glass } 769293d7fbdSSimon Glass 770293d7fbdSSimon Glass static int ext4fs_write_file(struct ext2_inode *file_inode, 771293d7fbdSSimon Glass int pos, unsigned int len, char *buf) 772293d7fbdSSimon Glass { 773293d7fbdSSimon Glass int i; 774293d7fbdSSimon Glass int blockcnt; 775293d7fbdSSimon Glass unsigned int filesize = __le32_to_cpu(file_inode->size); 776293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 77750ce4c07SEgbert Eich int log2blksz = fs->dev_desc->log2blksz; 77850ce4c07SEgbert Eich int log2_fs_blocksize = LOG2_BLOCK_SIZE(ext4fs_root) - log2blksz; 779293d7fbdSSimon Glass int previous_block_number = -1; 780293d7fbdSSimon Glass int delayed_start = 0; 781293d7fbdSSimon Glass int delayed_extent = 0; 782293d7fbdSSimon Glass int delayed_next = 0; 783293d7fbdSSimon Glass char *delayed_buf = NULL; 784293d7fbdSSimon Glass 785293d7fbdSSimon Glass /* Adjust len so it we can't read past the end of the file. */ 786293d7fbdSSimon Glass if (len > filesize) 787293d7fbdSSimon Glass len = filesize; 788293d7fbdSSimon Glass 789293d7fbdSSimon Glass blockcnt = ((len + pos) + fs->blksz - 1) / fs->blksz; 790293d7fbdSSimon Glass 791293d7fbdSSimon Glass for (i = pos / fs->blksz; i < blockcnt; i++) { 792293d7fbdSSimon Glass long int blknr; 793293d7fbdSSimon Glass int blockend = fs->blksz; 794293d7fbdSSimon Glass int skipfirst = 0; 795293d7fbdSSimon Glass blknr = read_allocated_block(file_inode, i); 796293d7fbdSSimon Glass if (blknr < 0) 797293d7fbdSSimon Glass return -1; 798293d7fbdSSimon Glass 79950ce4c07SEgbert Eich blknr = blknr << log2_fs_blocksize; 800293d7fbdSSimon Glass 801293d7fbdSSimon Glass if (blknr) { 802293d7fbdSSimon Glass if (previous_block_number != -1) { 803293d7fbdSSimon Glass if (delayed_next == blknr) { 804293d7fbdSSimon Glass delayed_extent += blockend; 80550ce4c07SEgbert Eich delayed_next += blockend >> log2blksz; 806293d7fbdSSimon Glass } else { /* spill */ 80750ce4c07SEgbert Eich put_ext4((uint64_t) 80850ce4c07SEgbert Eich (delayed_start << log2blksz), 809293d7fbdSSimon Glass delayed_buf, 810293d7fbdSSimon Glass (uint32_t) delayed_extent); 811293d7fbdSSimon Glass previous_block_number = blknr; 812293d7fbdSSimon Glass delayed_start = blknr; 813293d7fbdSSimon Glass delayed_extent = blockend; 814293d7fbdSSimon Glass delayed_buf = buf; 815293d7fbdSSimon Glass delayed_next = blknr + 81650ce4c07SEgbert Eich (blockend >> log2blksz); 817293d7fbdSSimon Glass } 818293d7fbdSSimon Glass } else { 819293d7fbdSSimon Glass previous_block_number = blknr; 820293d7fbdSSimon Glass delayed_start = blknr; 821293d7fbdSSimon Glass delayed_extent = blockend; 822293d7fbdSSimon Glass delayed_buf = buf; 823293d7fbdSSimon Glass delayed_next = blknr + 82450ce4c07SEgbert Eich (blockend >> log2blksz); 825293d7fbdSSimon Glass } 826293d7fbdSSimon Glass } else { 827293d7fbdSSimon Glass if (previous_block_number != -1) { 828293d7fbdSSimon Glass /* spill */ 82950ce4c07SEgbert Eich put_ext4((uint64_t) (delayed_start << 83050ce4c07SEgbert Eich log2blksz), 83150ce4c07SEgbert Eich delayed_buf, 832293d7fbdSSimon Glass (uint32_t) delayed_extent); 833293d7fbdSSimon Glass previous_block_number = -1; 834293d7fbdSSimon Glass } 835293d7fbdSSimon Glass memset(buf, 0, fs->blksz - skipfirst); 836293d7fbdSSimon Glass } 837293d7fbdSSimon Glass buf += fs->blksz - skipfirst; 838293d7fbdSSimon Glass } 839293d7fbdSSimon Glass if (previous_block_number != -1) { 840293d7fbdSSimon Glass /* spill */ 84150ce4c07SEgbert Eich put_ext4((uint64_t) (delayed_start << log2blksz), 842293d7fbdSSimon Glass delayed_buf, (uint32_t) delayed_extent); 843293d7fbdSSimon Glass previous_block_number = -1; 844293d7fbdSSimon Glass } 845293d7fbdSSimon Glass 846293d7fbdSSimon Glass return len; 847293d7fbdSSimon Glass } 848293d7fbdSSimon Glass 849293d7fbdSSimon Glass int ext4fs_write(const char *fname, unsigned char *buffer, 850293d7fbdSSimon Glass unsigned long sizebytes) 851293d7fbdSSimon Glass { 852293d7fbdSSimon Glass int ret = 0; 853293d7fbdSSimon Glass struct ext2_inode *file_inode = NULL; 854293d7fbdSSimon Glass unsigned char *inode_buffer = NULL; 855293d7fbdSSimon Glass int parent_inodeno; 856293d7fbdSSimon Glass int inodeno; 857293d7fbdSSimon Glass time_t timestamp = 0; 858293d7fbdSSimon Glass 859293d7fbdSSimon Glass uint64_t bytes_reqd_for_file; 860293d7fbdSSimon Glass unsigned int blks_reqd_for_file; 861293d7fbdSSimon Glass unsigned int blocks_remaining; 862293d7fbdSSimon Glass int existing_file_inodeno; 863293d7fbdSSimon Glass char *temp_ptr = NULL; 864293d7fbdSSimon Glass long int itable_blkno; 865293d7fbdSSimon Glass long int parent_itable_blkno; 866293d7fbdSSimon Glass long int blkoff; 867293d7fbdSSimon Glass struct ext2_sblock *sblock = &(ext4fs_root->sblock); 868293d7fbdSSimon Glass unsigned int inodes_per_block; 869293d7fbdSSimon Glass unsigned int ibmap_idx; 870293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 871293d7fbdSSimon Glass ALLOC_CACHE_ALIGN_BUFFER(char, filename, 256); 872293d7fbdSSimon Glass memset(filename, 0x00, sizeof(filename)); 873293d7fbdSSimon Glass 874293d7fbdSSimon Glass g_parent_inode = zalloc(sizeof(struct ext2_inode)); 875293d7fbdSSimon Glass if (!g_parent_inode) 876293d7fbdSSimon Glass goto fail; 877293d7fbdSSimon Glass 878293d7fbdSSimon Glass if (ext4fs_init() != 0) { 879293d7fbdSSimon Glass printf("error in File System init\n"); 880293d7fbdSSimon Glass return -1; 881293d7fbdSSimon Glass } 882293d7fbdSSimon Glass inodes_per_block = fs->blksz / fs->inodesz; 883293d7fbdSSimon Glass parent_inodeno = ext4fs_get_parent_inode_num(fname, filename, F_FILE); 884293d7fbdSSimon Glass if (parent_inodeno == -1) 885293d7fbdSSimon Glass goto fail; 886293d7fbdSSimon Glass if (ext4fs_iget(parent_inodeno, g_parent_inode)) 887293d7fbdSSimon Glass goto fail; 888293d7fbdSSimon Glass /* check if the filename is already present in root */ 889293d7fbdSSimon Glass existing_file_inodeno = ext4fs_filename_check(filename); 890293d7fbdSSimon Glass if (existing_file_inodeno != -1) { 891293d7fbdSSimon Glass ret = ext4fs_delete_file(existing_file_inodeno); 892293d7fbdSSimon Glass fs->first_pass_bbmap = 0; 893293d7fbdSSimon Glass fs->curr_blkno = 0; 894293d7fbdSSimon Glass 895293d7fbdSSimon Glass fs->first_pass_ibmap = 0; 896293d7fbdSSimon Glass fs->curr_inode_no = 0; 897293d7fbdSSimon Glass if (ret) 898293d7fbdSSimon Glass goto fail; 899293d7fbdSSimon Glass } 900293d7fbdSSimon Glass /* calucalate how many blocks required */ 901293d7fbdSSimon Glass bytes_reqd_for_file = sizebytes; 902293d7fbdSSimon Glass blks_reqd_for_file = lldiv(bytes_reqd_for_file, fs->blksz); 903293d7fbdSSimon Glass if (do_div(bytes_reqd_for_file, fs->blksz) != 0) { 904293d7fbdSSimon Glass blks_reqd_for_file++; 905293d7fbdSSimon Glass debug("total bytes for a file %u\n", blks_reqd_for_file); 906293d7fbdSSimon Glass } 907293d7fbdSSimon Glass blocks_remaining = blks_reqd_for_file; 908293d7fbdSSimon Glass /* test for available space in partition */ 909293d7fbdSSimon Glass if (fs->sb->free_blocks < blks_reqd_for_file) { 910293d7fbdSSimon Glass printf("Not enough space on partition !!!\n"); 911293d7fbdSSimon Glass goto fail; 912293d7fbdSSimon Glass } 913293d7fbdSSimon Glass 914293d7fbdSSimon Glass ext4fs_update_parent_dentry(filename, &inodeno, FILETYPE_REG); 915293d7fbdSSimon Glass /* prepare file inode */ 916293d7fbdSSimon Glass inode_buffer = zalloc(fs->inodesz); 917293d7fbdSSimon Glass if (!inode_buffer) 918293d7fbdSSimon Glass goto fail; 919293d7fbdSSimon Glass file_inode = (struct ext2_inode *)inode_buffer; 920293d7fbdSSimon Glass file_inode->mode = S_IFREG | S_IRWXU | 921293d7fbdSSimon Glass S_IRGRP | S_IROTH | S_IXGRP | S_IXOTH; 922293d7fbdSSimon Glass /* ToDo: Update correct time */ 923293d7fbdSSimon Glass file_inode->mtime = timestamp; 924293d7fbdSSimon Glass file_inode->atime = timestamp; 925293d7fbdSSimon Glass file_inode->ctime = timestamp; 926293d7fbdSSimon Glass file_inode->nlinks = 1; 927293d7fbdSSimon Glass file_inode->size = sizebytes; 928293d7fbdSSimon Glass 929293d7fbdSSimon Glass /* Allocate data blocks */ 930293d7fbdSSimon Glass ext4fs_allocate_blocks(file_inode, blocks_remaining, 931293d7fbdSSimon Glass &blks_reqd_for_file); 93250ce4c07SEgbert Eich file_inode->blockcnt = (blks_reqd_for_file * fs->blksz) >> 93350ce4c07SEgbert Eich fs->dev_desc->log2blksz; 934293d7fbdSSimon Glass 935293d7fbdSSimon Glass temp_ptr = zalloc(fs->blksz); 936293d7fbdSSimon Glass if (!temp_ptr) 937293d7fbdSSimon Glass goto fail; 938293d7fbdSSimon Glass ibmap_idx = inodeno / ext4fs_root->sblock.inodes_per_group; 939293d7fbdSSimon Glass inodeno--; 940293d7fbdSSimon Glass itable_blkno = __le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) + 941293d7fbdSSimon Glass (inodeno % __le32_to_cpu(sblock->inodes_per_group)) / 942293d7fbdSSimon Glass inodes_per_block; 943293d7fbdSSimon Glass blkoff = (inodeno % inodes_per_block) * fs->inodesz; 944*04735e9cSFrederic Leroy ext4fs_devread((lbaint_t)itable_blkno * fs->sect_perblk, 0, fs->blksz, 945*04735e9cSFrederic Leroy temp_ptr); 946293d7fbdSSimon Glass if (ext4fs_log_journal(temp_ptr, itable_blkno)) 947293d7fbdSSimon Glass goto fail; 948293d7fbdSSimon Glass 949293d7fbdSSimon Glass memcpy(temp_ptr + blkoff, inode_buffer, fs->inodesz); 950293d7fbdSSimon Glass if (ext4fs_put_metadata(temp_ptr, itable_blkno)) 951293d7fbdSSimon Glass goto fail; 952293d7fbdSSimon Glass /* copy the file content into data blocks */ 953293d7fbdSSimon Glass if (ext4fs_write_file(file_inode, 0, sizebytes, (char *)buffer) == -1) { 954293d7fbdSSimon Glass printf("Error in copying content\n"); 955293d7fbdSSimon Glass goto fail; 956293d7fbdSSimon Glass } 957293d7fbdSSimon Glass ibmap_idx = parent_inodeno / ext4fs_root->sblock.inodes_per_group; 958293d7fbdSSimon Glass parent_inodeno--; 959293d7fbdSSimon Glass parent_itable_blkno = __le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) + 960293d7fbdSSimon Glass (parent_inodeno % 961293d7fbdSSimon Glass __le32_to_cpu(sblock->inodes_per_group)) / inodes_per_block; 962293d7fbdSSimon Glass blkoff = (parent_inodeno % inodes_per_block) * fs->inodesz; 963293d7fbdSSimon Glass if (parent_itable_blkno != itable_blkno) { 964293d7fbdSSimon Glass memset(temp_ptr, '\0', fs->blksz); 965*04735e9cSFrederic Leroy ext4fs_devread((lbaint_t)parent_itable_blkno * fs->sect_perblk, 966293d7fbdSSimon Glass 0, fs->blksz, temp_ptr); 967293d7fbdSSimon Glass if (ext4fs_log_journal(temp_ptr, parent_itable_blkno)) 968293d7fbdSSimon Glass goto fail; 969293d7fbdSSimon Glass 970293d7fbdSSimon Glass memcpy(temp_ptr + blkoff, g_parent_inode, 971293d7fbdSSimon Glass sizeof(struct ext2_inode)); 972293d7fbdSSimon Glass if (ext4fs_put_metadata(temp_ptr, parent_itable_blkno)) 973293d7fbdSSimon Glass goto fail; 974293d7fbdSSimon Glass free(temp_ptr); 975293d7fbdSSimon Glass } else { 976293d7fbdSSimon Glass /* 977293d7fbdSSimon Glass * If parent and child fall in same inode table block 978293d7fbdSSimon Glass * both should be kept in 1 buffer 979293d7fbdSSimon Glass */ 980293d7fbdSSimon Glass memcpy(temp_ptr + blkoff, g_parent_inode, 981293d7fbdSSimon Glass sizeof(struct ext2_inode)); 982293d7fbdSSimon Glass gd_index--; 983293d7fbdSSimon Glass if (ext4fs_put_metadata(temp_ptr, itable_blkno)) 984293d7fbdSSimon Glass goto fail; 985293d7fbdSSimon Glass free(temp_ptr); 986293d7fbdSSimon Glass } 987293d7fbdSSimon Glass ext4fs_update(); 988293d7fbdSSimon Glass ext4fs_deinit(); 989293d7fbdSSimon Glass 990293d7fbdSSimon Glass fs->first_pass_bbmap = 0; 991293d7fbdSSimon Glass fs->curr_blkno = 0; 992293d7fbdSSimon Glass fs->first_pass_ibmap = 0; 993293d7fbdSSimon Glass fs->curr_inode_no = 0; 994293d7fbdSSimon Glass free(inode_buffer); 995293d7fbdSSimon Glass free(g_parent_inode); 996293d7fbdSSimon Glass g_parent_inode = NULL; 997293d7fbdSSimon Glass 998293d7fbdSSimon Glass return 0; 999293d7fbdSSimon Glass fail: 1000293d7fbdSSimon Glass ext4fs_deinit(); 1001293d7fbdSSimon Glass free(inode_buffer); 1002293d7fbdSSimon Glass free(g_parent_inode); 1003293d7fbdSSimon Glass g_parent_inode = NULL; 1004293d7fbdSSimon Glass 1005293d7fbdSSimon Glass return -1; 1006293d7fbdSSimon Glass } 1007