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