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