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 * 211a459660SWolfgang 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); 430550870bSMa Haijun put_ext4((uint64_t)((uint64_t)fs->bgd[i].block_id * (uint64_t)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++) { 490550870bSMa Haijun put_ext4((uint64_t) ((uint64_t)fs->bgd[i].inode_id * (uint64_t)fs->blksz), 50293d7fbdSSimon Glass fs->inode_bmaps[i], fs->blksz); 51293d7fbdSSimon Glass } 52293d7fbdSSimon Glass 53293d7fbdSSimon Glass /* update the block group descriptor table */ 540550870bSMa Haijun put_ext4((uint64_t)((uint64_t)fs->gdtable_blkno * (uint64_t)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 bg_idx = blknr / blk_per_grp; 12035dd055bSŁukasz Majewski if (fs->blksz == 1024) { 121293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 122293d7fbdSSimon Glass if (!remainder) 123293d7fbdSSimon Glass bg_idx--; 124293d7fbdSSimon Glass } 125293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx); 126293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 127293d7fbdSSimon Glass fs->sb->free_blocks++; 128293d7fbdSSimon Glass /* journal backup */ 129293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 130293d7fbdSSimon Glass status = 13104735e9cSFrederic Leroy ext4fs_devread((lbaint_t)bgd[bg_idx].block_id * 132293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 133293d7fbdSSimon Glass journal_buffer); 134293d7fbdSSimon Glass if (status == 0) 135293d7fbdSSimon Glass goto fail; 136293d7fbdSSimon Glass if (ext4fs_log_journal 137293d7fbdSSimon Glass (journal_buffer, bgd[bg_idx].block_id)) 138293d7fbdSSimon Glass goto fail; 139293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 140293d7fbdSSimon Glass } 141293d7fbdSSimon Glass } 142293d7fbdSSimon Glass fail: 143293d7fbdSSimon Glass free(journal_buffer); 144293d7fbdSSimon Glass } 145293d7fbdSSimon Glass 146293d7fbdSSimon Glass static void delete_double_indirect_block(struct ext2_inode *inode) 147293d7fbdSSimon Glass { 148293d7fbdSSimon Glass int i; 149293d7fbdSSimon Glass short status; 150293d7fbdSSimon Glass static int prev_bg_bmap_idx = -1; 151293d7fbdSSimon Glass long int blknr; 152293d7fbdSSimon Glass int remainder; 153293d7fbdSSimon Glass int bg_idx; 154293d7fbdSSimon Glass unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group; 155293d7fbdSSimon Glass unsigned int *di_buffer = NULL; 156293d7fbdSSimon Glass unsigned int *DIB_start_addr = NULL; 157293d7fbdSSimon Glass struct ext2_block_group *bgd = NULL; 158293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 159293d7fbdSSimon Glass char *journal_buffer = zalloc(fs->blksz); 160293d7fbdSSimon Glass if (!journal_buffer) { 161293d7fbdSSimon Glass printf("No memory\n"); 162293d7fbdSSimon Glass return; 163293d7fbdSSimon Glass } 164293d7fbdSSimon Glass /* get the block group descriptor table */ 165293d7fbdSSimon Glass bgd = (struct ext2_block_group *)fs->gdtable; 166293d7fbdSSimon Glass 167293d7fbdSSimon Glass if (inode->b.blocks.double_indir_block != 0) { 168293d7fbdSSimon Glass di_buffer = zalloc(fs->blksz); 169293d7fbdSSimon Glass if (!di_buffer) { 170293d7fbdSSimon Glass printf("No memory\n"); 171293d7fbdSSimon Glass return; 172293d7fbdSSimon Glass } 173293d7fbdSSimon Glass DIB_start_addr = (unsigned int *)di_buffer; 174293d7fbdSSimon Glass blknr = inode->b.blocks.double_indir_block; 17504735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, 17604735e9cSFrederic Leroy fs->blksz, (char *)di_buffer); 177293d7fbdSSimon Glass for (i = 0; i < fs->blksz / sizeof(int); i++) { 178293d7fbdSSimon Glass if (*di_buffer == 0) 179293d7fbdSSimon Glass break; 180293d7fbdSSimon Glass 181293d7fbdSSimon Glass debug("DICB releasing %u\n", *di_buffer); 18235dd055bSŁukasz Majewski bg_idx = *di_buffer / blk_per_grp; 18335dd055bSŁukasz Majewski if (fs->blksz == 1024) { 18435dd055bSŁukasz Majewski remainder = *di_buffer % blk_per_grp; 185293d7fbdSSimon Glass if (!remainder) 186293d7fbdSSimon Glass bg_idx--; 187293d7fbdSSimon Glass } 188293d7fbdSSimon Glass ext4fs_reset_block_bmap(*di_buffer, 189293d7fbdSSimon Glass fs->blk_bmaps[bg_idx], bg_idx); 190293d7fbdSSimon Glass di_buffer++; 191293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 192293d7fbdSSimon Glass fs->sb->free_blocks++; 193293d7fbdSSimon Glass /* journal backup */ 194293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 19504735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t) 19604735e9cSFrederic Leroy bgd[bg_idx].block_id 197293d7fbdSSimon Glass * fs->sect_perblk, 0, 198293d7fbdSSimon Glass fs->blksz, 199293d7fbdSSimon Glass journal_buffer); 200293d7fbdSSimon Glass if (status == 0) 201293d7fbdSSimon Glass goto fail; 202293d7fbdSSimon Glass 203293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 204293d7fbdSSimon Glass bgd[bg_idx].block_id)) 205293d7fbdSSimon Glass goto fail; 206293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 207293d7fbdSSimon Glass } 208293d7fbdSSimon Glass } 209293d7fbdSSimon Glass 210293d7fbdSSimon Glass /* removing the parent double indirect block */ 211293d7fbdSSimon Glass blknr = inode->b.blocks.double_indir_block; 212293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 21335dd055bSŁukasz Majewski if (fs->blksz == 1024) { 214293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 215293d7fbdSSimon Glass if (!remainder) 216293d7fbdSSimon Glass bg_idx--; 217293d7fbdSSimon Glass } 218293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx); 219293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 220293d7fbdSSimon Glass fs->sb->free_blocks++; 221293d7fbdSSimon Glass /* journal backup */ 222293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 223293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 22404735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)bgd[bg_idx].block_id * 225293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 226293d7fbdSSimon Glass journal_buffer); 227293d7fbdSSimon Glass if (status == 0) 228293d7fbdSSimon Glass goto fail; 229293d7fbdSSimon Glass 230293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 231293d7fbdSSimon Glass bgd[bg_idx].block_id)) 232293d7fbdSSimon Glass goto fail; 233293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 234293d7fbdSSimon Glass } 235293d7fbdSSimon Glass debug("DIPB releasing %ld\n", blknr); 236293d7fbdSSimon Glass } 237293d7fbdSSimon Glass fail: 238293d7fbdSSimon Glass free(DIB_start_addr); 239293d7fbdSSimon Glass free(journal_buffer); 240293d7fbdSSimon Glass } 241293d7fbdSSimon Glass 242293d7fbdSSimon Glass static void delete_triple_indirect_block(struct ext2_inode *inode) 243293d7fbdSSimon Glass { 244293d7fbdSSimon Glass int i, j; 245293d7fbdSSimon Glass short status; 246293d7fbdSSimon Glass static int prev_bg_bmap_idx = -1; 247293d7fbdSSimon Glass long int blknr; 248293d7fbdSSimon Glass int remainder; 249293d7fbdSSimon Glass int bg_idx; 250293d7fbdSSimon Glass unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group; 251293d7fbdSSimon Glass unsigned int *tigp_buffer = NULL; 252293d7fbdSSimon Glass unsigned int *tib_start_addr = NULL; 253293d7fbdSSimon Glass unsigned int *tip_buffer = NULL; 254293d7fbdSSimon Glass unsigned int *tipb_start_addr = NULL; 255293d7fbdSSimon Glass struct ext2_block_group *bgd = NULL; 256293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 257293d7fbdSSimon Glass char *journal_buffer = zalloc(fs->blksz); 258293d7fbdSSimon Glass if (!journal_buffer) { 259293d7fbdSSimon Glass printf("No memory\n"); 260293d7fbdSSimon Glass return; 261293d7fbdSSimon Glass } 262293d7fbdSSimon Glass /* get block group descriptor table */ 263293d7fbdSSimon Glass bgd = (struct ext2_block_group *)fs->gdtable; 264293d7fbdSSimon Glass 265293d7fbdSSimon Glass if (inode->b.blocks.triple_indir_block != 0) { 266293d7fbdSSimon Glass tigp_buffer = zalloc(fs->blksz); 267293d7fbdSSimon Glass if (!tigp_buffer) { 268293d7fbdSSimon Glass printf("No memory\n"); 269293d7fbdSSimon Glass return; 270293d7fbdSSimon Glass } 271293d7fbdSSimon Glass tib_start_addr = (unsigned int *)tigp_buffer; 272293d7fbdSSimon Glass blknr = inode->b.blocks.triple_indir_block; 27304735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, 27404735e9cSFrederic Leroy fs->blksz, (char *)tigp_buffer); 275293d7fbdSSimon Glass for (i = 0; i < fs->blksz / sizeof(int); i++) { 276293d7fbdSSimon Glass if (*tigp_buffer == 0) 277293d7fbdSSimon Glass break; 278293d7fbdSSimon Glass debug("tigp buffer releasing %u\n", *tigp_buffer); 279293d7fbdSSimon Glass 280293d7fbdSSimon Glass tip_buffer = zalloc(fs->blksz); 281293d7fbdSSimon Glass if (!tip_buffer) 282293d7fbdSSimon Glass goto fail; 283293d7fbdSSimon Glass tipb_start_addr = (unsigned int *)tip_buffer; 28404735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)(*tigp_buffer) * 285293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 286293d7fbdSSimon Glass (char *)tip_buffer); 287293d7fbdSSimon Glass for (j = 0; j < fs->blksz / sizeof(int); j++) { 288293d7fbdSSimon Glass if (*tip_buffer == 0) 289293d7fbdSSimon Glass break; 29035dd055bSŁukasz Majewski bg_idx = *tip_buffer / blk_per_grp; 29135dd055bSŁukasz Majewski if (fs->blksz == 1024) { 29235dd055bSŁukasz Majewski remainder = *tip_buffer % blk_per_grp; 293293d7fbdSSimon Glass if (!remainder) 294293d7fbdSSimon Glass bg_idx--; 295293d7fbdSSimon Glass } 296293d7fbdSSimon Glass 297293d7fbdSSimon Glass ext4fs_reset_block_bmap(*tip_buffer, 298293d7fbdSSimon Glass fs->blk_bmaps[bg_idx], 299293d7fbdSSimon Glass bg_idx); 300293d7fbdSSimon Glass 301293d7fbdSSimon Glass tip_buffer++; 302293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 303293d7fbdSSimon Glass fs->sb->free_blocks++; 304293d7fbdSSimon Glass /* journal backup */ 305293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 306293d7fbdSSimon Glass status = 307293d7fbdSSimon Glass ext4fs_devread( 30804735e9cSFrederic Leroy (lbaint_t) 309293d7fbdSSimon Glass bgd[bg_idx].block_id * 310293d7fbdSSimon Glass fs->sect_perblk, 0, 311293d7fbdSSimon Glass fs->blksz, 312293d7fbdSSimon Glass journal_buffer); 313293d7fbdSSimon Glass if (status == 0) 314293d7fbdSSimon Glass goto fail; 315293d7fbdSSimon Glass 316293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 317293d7fbdSSimon Glass bgd[bg_idx]. 318293d7fbdSSimon Glass block_id)) 319293d7fbdSSimon Glass goto fail; 320293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 321293d7fbdSSimon Glass } 322293d7fbdSSimon Glass } 323293d7fbdSSimon Glass free(tipb_start_addr); 324293d7fbdSSimon Glass tipb_start_addr = NULL; 325293d7fbdSSimon Glass 326293d7fbdSSimon Glass /* 327293d7fbdSSimon Glass * removing the grand parent blocks 328293d7fbdSSimon Glass * which is connected to inode 329293d7fbdSSimon Glass */ 33035dd055bSŁukasz Majewski bg_idx = *tigp_buffer / blk_per_grp; 33135dd055bSŁukasz Majewski if (fs->blksz == 1024) { 33235dd055bSŁukasz Majewski remainder = *tigp_buffer % blk_per_grp; 333293d7fbdSSimon Glass if (!remainder) 334293d7fbdSSimon Glass bg_idx--; 335293d7fbdSSimon Glass } 336293d7fbdSSimon Glass ext4fs_reset_block_bmap(*tigp_buffer, 337293d7fbdSSimon Glass fs->blk_bmaps[bg_idx], bg_idx); 338293d7fbdSSimon Glass 339293d7fbdSSimon Glass tigp_buffer++; 340293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 341293d7fbdSSimon Glass fs->sb->free_blocks++; 342293d7fbdSSimon Glass /* journal backup */ 343293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 344293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 345293d7fbdSSimon Glass status = 34604735e9cSFrederic Leroy ext4fs_devread((lbaint_t) 34704735e9cSFrederic Leroy bgd[bg_idx].block_id * 348293d7fbdSSimon Glass fs->sect_perblk, 0, 349293d7fbdSSimon Glass fs->blksz, journal_buffer); 350293d7fbdSSimon Glass if (status == 0) 351293d7fbdSSimon Glass goto fail; 352293d7fbdSSimon Glass 353293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 354293d7fbdSSimon Glass bgd[bg_idx].block_id)) 355293d7fbdSSimon Glass goto fail; 356293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 357293d7fbdSSimon Glass } 358293d7fbdSSimon Glass } 359293d7fbdSSimon Glass 360293d7fbdSSimon Glass /* removing the grand parent triple indirect block */ 361293d7fbdSSimon Glass blknr = inode->b.blocks.triple_indir_block; 362293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 36335dd055bSŁukasz Majewski if (fs->blksz == 1024) { 364293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 365293d7fbdSSimon Glass if (!remainder) 366293d7fbdSSimon Glass bg_idx--; 367293d7fbdSSimon Glass } 368293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx); 369293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 370293d7fbdSSimon Glass fs->sb->free_blocks++; 371293d7fbdSSimon Glass /* journal backup */ 372293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 373293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 37404735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)bgd[bg_idx].block_id * 375293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 376293d7fbdSSimon Glass journal_buffer); 377293d7fbdSSimon Glass if (status == 0) 378293d7fbdSSimon Glass goto fail; 379293d7fbdSSimon Glass 380293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 381293d7fbdSSimon Glass bgd[bg_idx].block_id)) 382293d7fbdSSimon Glass goto fail; 383293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 384293d7fbdSSimon Glass } 385293d7fbdSSimon Glass debug("tigp buffer itself releasing %ld\n", blknr); 386293d7fbdSSimon Glass } 387293d7fbdSSimon Glass fail: 388293d7fbdSSimon Glass free(tib_start_addr); 389293d7fbdSSimon Glass free(tipb_start_addr); 390293d7fbdSSimon Glass free(journal_buffer); 391293d7fbdSSimon Glass } 392293d7fbdSSimon Glass 393293d7fbdSSimon Glass static int ext4fs_delete_file(int inodeno) 394293d7fbdSSimon Glass { 395293d7fbdSSimon Glass struct ext2_inode inode; 396293d7fbdSSimon Glass short status; 397293d7fbdSSimon Glass int i; 398293d7fbdSSimon Glass int remainder; 399293d7fbdSSimon Glass long int blknr; 400293d7fbdSSimon Glass int bg_idx; 401293d7fbdSSimon Glass int ibmap_idx; 402293d7fbdSSimon Glass char *read_buffer = NULL; 403293d7fbdSSimon Glass char *start_block_address = NULL; 404293d7fbdSSimon Glass unsigned int no_blocks; 405293d7fbdSSimon Glass 406293d7fbdSSimon Glass static int prev_bg_bmap_idx = -1; 407293d7fbdSSimon Glass unsigned int inodes_per_block; 408293d7fbdSSimon Glass long int blkno; 409293d7fbdSSimon Glass unsigned int blkoff; 410293d7fbdSSimon Glass unsigned int blk_per_grp = ext4fs_root->sblock.blocks_per_group; 411293d7fbdSSimon Glass unsigned int inode_per_grp = ext4fs_root->sblock.inodes_per_group; 412293d7fbdSSimon Glass struct ext2_inode *inode_buffer = NULL; 413293d7fbdSSimon Glass struct ext2_block_group *bgd = NULL; 414293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 415293d7fbdSSimon Glass char *journal_buffer = zalloc(fs->blksz); 416293d7fbdSSimon Glass if (!journal_buffer) 417293d7fbdSSimon Glass return -ENOMEM; 418293d7fbdSSimon Glass /* get the block group descriptor table */ 419293d7fbdSSimon Glass bgd = (struct ext2_block_group *)fs->gdtable; 420293d7fbdSSimon Glass status = ext4fs_read_inode(ext4fs_root, inodeno, &inode); 421293d7fbdSSimon Glass if (status == 0) 422293d7fbdSSimon Glass goto fail; 423293d7fbdSSimon Glass 424293d7fbdSSimon Glass /* read the block no allocated to a file */ 425293d7fbdSSimon Glass no_blocks = inode.size / fs->blksz; 426293d7fbdSSimon Glass if (inode.size % fs->blksz) 427293d7fbdSSimon Glass no_blocks++; 428293d7fbdSSimon Glass 429293d7fbdSSimon Glass if (le32_to_cpu(inode.flags) & EXT4_EXTENTS_FL) { 430293d7fbdSSimon Glass struct ext2fs_node *node_inode = 431293d7fbdSSimon Glass zalloc(sizeof(struct ext2fs_node)); 432293d7fbdSSimon Glass if (!node_inode) 433293d7fbdSSimon Glass goto fail; 434293d7fbdSSimon Glass node_inode->data = ext4fs_root; 435293d7fbdSSimon Glass node_inode->ino = inodeno; 436293d7fbdSSimon Glass node_inode->inode_read = 0; 437293d7fbdSSimon Glass memcpy(&(node_inode->inode), &inode, sizeof(struct ext2_inode)); 438293d7fbdSSimon Glass 439293d7fbdSSimon Glass for (i = 0; i < no_blocks; i++) { 440293d7fbdSSimon Glass blknr = read_allocated_block(&(node_inode->inode), i); 441293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 44235dd055bSŁukasz Majewski if (fs->blksz == 1024) { 443293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 444293d7fbdSSimon Glass if (!remainder) 445293d7fbdSSimon Glass bg_idx--; 446293d7fbdSSimon Glass } 447293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], 448293d7fbdSSimon Glass bg_idx); 449293d7fbdSSimon Glass debug("EXT4_EXTENTS Block releasing %ld: %d\n", 450293d7fbdSSimon Glass blknr, bg_idx); 451293d7fbdSSimon Glass 452293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 453293d7fbdSSimon Glass fs->sb->free_blocks++; 454293d7fbdSSimon Glass 455293d7fbdSSimon Glass /* journal backup */ 456293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 457293d7fbdSSimon Glass status = 45804735e9cSFrederic Leroy ext4fs_devread((lbaint_t) 45904735e9cSFrederic Leroy bgd[bg_idx].block_id * 460293d7fbdSSimon Glass fs->sect_perblk, 0, 461293d7fbdSSimon Glass fs->blksz, journal_buffer); 462293d7fbdSSimon Glass if (status == 0) 463293d7fbdSSimon Glass goto fail; 464293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 465293d7fbdSSimon Glass bgd[bg_idx].block_id)) 466293d7fbdSSimon Glass goto fail; 467293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 468293d7fbdSSimon Glass } 469293d7fbdSSimon Glass } 470293d7fbdSSimon Glass if (node_inode) { 471293d7fbdSSimon Glass free(node_inode); 472293d7fbdSSimon Glass node_inode = NULL; 473293d7fbdSSimon Glass } 474293d7fbdSSimon Glass } else { 475293d7fbdSSimon Glass 476293d7fbdSSimon Glass delete_single_indirect_block(&inode); 477293d7fbdSSimon Glass delete_double_indirect_block(&inode); 478293d7fbdSSimon Glass delete_triple_indirect_block(&inode); 479293d7fbdSSimon Glass 480293d7fbdSSimon Glass /* read the block no allocated to a file */ 481293d7fbdSSimon Glass no_blocks = inode.size / fs->blksz; 482293d7fbdSSimon Glass if (inode.size % fs->blksz) 483293d7fbdSSimon Glass no_blocks++; 484293d7fbdSSimon Glass for (i = 0; i < no_blocks; i++) { 485293d7fbdSSimon Glass blknr = read_allocated_block(&inode, i); 486293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 48735dd055bSŁukasz Majewski if (fs->blksz == 1024) { 488293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 489293d7fbdSSimon Glass if (!remainder) 490293d7fbdSSimon Glass bg_idx--; 491293d7fbdSSimon Glass } 492293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], 493293d7fbdSSimon Glass bg_idx); 494293d7fbdSSimon Glass debug("ActualB releasing %ld: %d\n", blknr, bg_idx); 495293d7fbdSSimon Glass 496293d7fbdSSimon Glass bgd[bg_idx].free_blocks++; 497293d7fbdSSimon Glass fs->sb->free_blocks++; 498293d7fbdSSimon Glass /* journal backup */ 499293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 500293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 50104735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t) 50204735e9cSFrederic Leroy bgd[bg_idx].block_id 503293d7fbdSSimon Glass * fs->sect_perblk, 504293d7fbdSSimon Glass 0, fs->blksz, 505293d7fbdSSimon Glass journal_buffer); 506293d7fbdSSimon Glass if (status == 0) 507293d7fbdSSimon Glass goto fail; 508293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 509293d7fbdSSimon Glass bgd[bg_idx].block_id)) 510293d7fbdSSimon Glass goto fail; 511293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 512293d7fbdSSimon Glass } 513293d7fbdSSimon Glass } 514293d7fbdSSimon Glass } 515293d7fbdSSimon Glass 516293d7fbdSSimon Glass /* from the inode no to blockno */ 517293d7fbdSSimon Glass inodes_per_block = fs->blksz / fs->inodesz; 518293d7fbdSSimon Glass ibmap_idx = inodeno / inode_per_grp; 519293d7fbdSSimon Glass 520293d7fbdSSimon Glass /* get the block no */ 521293d7fbdSSimon Glass inodeno--; 522293d7fbdSSimon Glass blkno = __le32_to_cpu(bgd[ibmap_idx].inode_table_id) + 523293d7fbdSSimon Glass (inodeno % __le32_to_cpu(inode_per_grp)) / inodes_per_block; 524293d7fbdSSimon Glass 525293d7fbdSSimon Glass /* get the offset of the inode */ 526293d7fbdSSimon Glass blkoff = ((inodeno) % inodes_per_block) * fs->inodesz; 527293d7fbdSSimon Glass 528293d7fbdSSimon Glass /* read the block no containing the inode */ 529293d7fbdSSimon Glass read_buffer = zalloc(fs->blksz); 530293d7fbdSSimon Glass if (!read_buffer) 531293d7fbdSSimon Glass goto fail; 532293d7fbdSSimon Glass start_block_address = read_buffer; 53304735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)blkno * fs->sect_perblk, 534293d7fbdSSimon Glass 0, fs->blksz, read_buffer); 535293d7fbdSSimon Glass if (status == 0) 536293d7fbdSSimon Glass goto fail; 537293d7fbdSSimon Glass 538293d7fbdSSimon Glass if (ext4fs_log_journal(read_buffer, blkno)) 539293d7fbdSSimon Glass goto fail; 540293d7fbdSSimon Glass 541293d7fbdSSimon Glass read_buffer = read_buffer + blkoff; 542293d7fbdSSimon Glass inode_buffer = (struct ext2_inode *)read_buffer; 543293d7fbdSSimon Glass memset(inode_buffer, '\0', sizeof(struct ext2_inode)); 544293d7fbdSSimon Glass 545293d7fbdSSimon Glass /* write the inode to original position in inode table */ 546293d7fbdSSimon Glass if (ext4fs_put_metadata(start_block_address, blkno)) 547293d7fbdSSimon Glass goto fail; 548293d7fbdSSimon Glass 549293d7fbdSSimon Glass /* update the respective inode bitmaps */ 550293d7fbdSSimon Glass inodeno++; 551293d7fbdSSimon Glass ext4fs_reset_inode_bmap(inodeno, fs->inode_bmaps[ibmap_idx], ibmap_idx); 552293d7fbdSSimon Glass bgd[ibmap_idx].free_inodes++; 553293d7fbdSSimon Glass fs->sb->free_inodes++; 554293d7fbdSSimon Glass /* journal backup */ 555293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 55604735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)bgd[ibmap_idx].inode_id * 557293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, journal_buffer); 558293d7fbdSSimon Glass if (status == 0) 559293d7fbdSSimon Glass goto fail; 560293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, bgd[ibmap_idx].inode_id)) 561293d7fbdSSimon Glass goto fail; 562293d7fbdSSimon Glass 563293d7fbdSSimon Glass ext4fs_update(); 564293d7fbdSSimon Glass ext4fs_deinit(); 565*8b454eeeSŁukasz Majewski ext4fs_reinit_global(); 566293d7fbdSSimon Glass 567293d7fbdSSimon Glass if (ext4fs_init() != 0) { 568293d7fbdSSimon Glass printf("error in File System init\n"); 569293d7fbdSSimon Glass goto fail; 570293d7fbdSSimon Glass } 571293d7fbdSSimon Glass 572293d7fbdSSimon Glass free(start_block_address); 573293d7fbdSSimon Glass free(journal_buffer); 574293d7fbdSSimon Glass 575293d7fbdSSimon Glass return 0; 576293d7fbdSSimon Glass fail: 577293d7fbdSSimon Glass free(start_block_address); 578293d7fbdSSimon Glass free(journal_buffer); 579293d7fbdSSimon Glass 580293d7fbdSSimon Glass return -1; 581293d7fbdSSimon Glass } 582293d7fbdSSimon Glass 583293d7fbdSSimon Glass int ext4fs_init(void) 584293d7fbdSSimon Glass { 585293d7fbdSSimon Glass short status; 586293d7fbdSSimon Glass int i; 587293d7fbdSSimon Glass unsigned int real_free_blocks = 0; 588293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 589293d7fbdSSimon Glass 590293d7fbdSSimon Glass /* populate fs */ 591293d7fbdSSimon Glass fs->blksz = EXT2_BLOCK_SIZE(ext4fs_root); 592293d7fbdSSimon Glass fs->inodesz = INODE_SIZE_FILESYSTEM(ext4fs_root); 59350ce4c07SEgbert Eich fs->sect_perblk = fs->blksz >> fs->dev_desc->log2blksz; 594293d7fbdSSimon Glass 595293d7fbdSSimon Glass /* get the superblock */ 596293d7fbdSSimon Glass fs->sb = zalloc(SUPERBLOCK_SIZE); 597293d7fbdSSimon Glass if (!fs->sb) 598293d7fbdSSimon Glass return -ENOMEM; 59950ce4c07SEgbert Eich if (!ext4_read_superblock((char *)fs->sb)) 600293d7fbdSSimon Glass goto fail; 601293d7fbdSSimon Glass 602293d7fbdSSimon Glass /* init journal */ 603293d7fbdSSimon Glass if (ext4fs_init_journal()) 604293d7fbdSSimon Glass goto fail; 605293d7fbdSSimon Glass 606293d7fbdSSimon Glass /* get total no of blockgroups */ 607293d7fbdSSimon Glass fs->no_blkgrp = (uint32_t)ext4fs_div_roundup( 608293d7fbdSSimon Glass (ext4fs_root->sblock.total_blocks - 609293d7fbdSSimon Glass ext4fs_root->sblock.first_data_block), 610293d7fbdSSimon Glass ext4fs_root->sblock.blocks_per_group); 611293d7fbdSSimon Glass 612293d7fbdSSimon Glass /* get the block group descriptor table */ 613293d7fbdSSimon Glass fs->gdtable_blkno = ((EXT2_MIN_BLOCK_SIZE == fs->blksz) + 1); 614293d7fbdSSimon Glass if (ext4fs_get_bgdtable() == -1) { 615293d7fbdSSimon Glass printf("Error in getting the block group descriptor table\n"); 616293d7fbdSSimon Glass goto fail; 617293d7fbdSSimon Glass } 618293d7fbdSSimon Glass fs->bgd = (struct ext2_block_group *)fs->gdtable; 619293d7fbdSSimon Glass 620293d7fbdSSimon Glass /* load all the available bitmap block of the partition */ 621293d7fbdSSimon Glass fs->blk_bmaps = zalloc(fs->no_blkgrp * sizeof(char *)); 622293d7fbdSSimon Glass if (!fs->blk_bmaps) 623293d7fbdSSimon Glass goto fail; 624293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 625293d7fbdSSimon Glass fs->blk_bmaps[i] = zalloc(fs->blksz); 626293d7fbdSSimon Glass if (!fs->blk_bmaps[i]) 627293d7fbdSSimon Glass goto fail; 628293d7fbdSSimon Glass } 629293d7fbdSSimon Glass 630293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 631293d7fbdSSimon Glass status = 63204735e9cSFrederic Leroy ext4fs_devread((lbaint_t)fs->bgd[i].block_id * 63304735e9cSFrederic Leroy fs->sect_perblk, 0, 634293d7fbdSSimon Glass fs->blksz, (char *)fs->blk_bmaps[i]); 635293d7fbdSSimon Glass if (status == 0) 636293d7fbdSSimon Glass goto fail; 637293d7fbdSSimon Glass } 638293d7fbdSSimon Glass 639293d7fbdSSimon Glass /* load all the available inode bitmap of the partition */ 640293d7fbdSSimon Glass fs->inode_bmaps = zalloc(fs->no_blkgrp * sizeof(unsigned char *)); 641293d7fbdSSimon Glass if (!fs->inode_bmaps) 642293d7fbdSSimon Glass goto fail; 643293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 644293d7fbdSSimon Glass fs->inode_bmaps[i] = zalloc(fs->blksz); 645293d7fbdSSimon Glass if (!fs->inode_bmaps[i]) 646293d7fbdSSimon Glass goto fail; 647293d7fbdSSimon Glass } 648293d7fbdSSimon Glass 649293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 65004735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)fs->bgd[i].inode_id * 65104735e9cSFrederic Leroy fs->sect_perblk, 652293d7fbdSSimon Glass 0, fs->blksz, 653293d7fbdSSimon Glass (char *)fs->inode_bmaps[i]); 654293d7fbdSSimon Glass if (status == 0) 655293d7fbdSSimon Glass goto fail; 656293d7fbdSSimon Glass } 657293d7fbdSSimon Glass 658293d7fbdSSimon Glass /* 659293d7fbdSSimon Glass * check filesystem consistency with free blocks of file system 660293d7fbdSSimon Glass * some time we observed that superblock freeblocks does not match 661293d7fbdSSimon Glass * with the blockgroups freeblocks when improper 662293d7fbdSSimon Glass * reboot of a linux kernel 663293d7fbdSSimon Glass */ 664293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) 665293d7fbdSSimon Glass real_free_blocks = real_free_blocks + fs->bgd[i].free_blocks; 666293d7fbdSSimon Glass if (real_free_blocks != fs->sb->free_blocks) 667293d7fbdSSimon Glass fs->sb->free_blocks = real_free_blocks; 668293d7fbdSSimon Glass 669293d7fbdSSimon Glass return 0; 670293d7fbdSSimon Glass fail: 671293d7fbdSSimon Glass ext4fs_deinit(); 672293d7fbdSSimon Glass 673293d7fbdSSimon Glass return -1; 674293d7fbdSSimon Glass } 675293d7fbdSSimon Glass 676293d7fbdSSimon Glass void ext4fs_deinit(void) 677293d7fbdSSimon Glass { 678293d7fbdSSimon Glass int i; 679293d7fbdSSimon Glass struct ext2_inode inode_journal; 680293d7fbdSSimon Glass struct journal_superblock_t *jsb; 681293d7fbdSSimon Glass long int blknr; 682293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 683293d7fbdSSimon Glass 684293d7fbdSSimon Glass /* free journal */ 685293d7fbdSSimon Glass char *temp_buff = zalloc(fs->blksz); 686293d7fbdSSimon Glass if (temp_buff) { 687293d7fbdSSimon Glass ext4fs_read_inode(ext4fs_root, EXT2_JOURNAL_INO, 688293d7fbdSSimon Glass &inode_journal); 689293d7fbdSSimon Glass blknr = read_allocated_block(&inode_journal, 690293d7fbdSSimon Glass EXT2_JOURNAL_SUPERBLOCK); 69104735e9cSFrederic Leroy ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, fs->blksz, 692293d7fbdSSimon Glass temp_buff); 693293d7fbdSSimon Glass jsb = (struct journal_superblock_t *)temp_buff; 694293d7fbdSSimon Glass jsb->s_start = cpu_to_be32(0); 6950550870bSMa Haijun put_ext4((uint64_t) ((uint64_t)blknr * (uint64_t)fs->blksz), 696293d7fbdSSimon Glass (struct journal_superblock_t *)temp_buff, fs->blksz); 697293d7fbdSSimon Glass free(temp_buff); 698293d7fbdSSimon Glass } 699293d7fbdSSimon Glass ext4fs_free_journal(); 700293d7fbdSSimon Glass 701293d7fbdSSimon Glass /* get the superblock */ 70250ce4c07SEgbert Eich ext4_read_superblock((char *)fs->sb); 703293d7fbdSSimon Glass fs->sb->feature_incompat &= ~EXT3_FEATURE_INCOMPAT_RECOVER; 704293d7fbdSSimon Glass put_ext4((uint64_t)(SUPERBLOCK_SIZE), 705293d7fbdSSimon Glass (struct ext2_sblock *)fs->sb, (uint32_t)SUPERBLOCK_SIZE); 706293d7fbdSSimon Glass free(fs->sb); 707293d7fbdSSimon Glass fs->sb = NULL; 708293d7fbdSSimon Glass 709293d7fbdSSimon Glass if (fs->blk_bmaps) { 710293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 711293d7fbdSSimon Glass free(fs->blk_bmaps[i]); 712293d7fbdSSimon Glass fs->blk_bmaps[i] = NULL; 713293d7fbdSSimon Glass } 714293d7fbdSSimon Glass free(fs->blk_bmaps); 715293d7fbdSSimon Glass fs->blk_bmaps = NULL; 716293d7fbdSSimon Glass } 717293d7fbdSSimon Glass 718293d7fbdSSimon Glass if (fs->inode_bmaps) { 719293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 720293d7fbdSSimon Glass free(fs->inode_bmaps[i]); 721293d7fbdSSimon Glass fs->inode_bmaps[i] = NULL; 722293d7fbdSSimon Glass } 723293d7fbdSSimon Glass free(fs->inode_bmaps); 724293d7fbdSSimon Glass fs->inode_bmaps = NULL; 725293d7fbdSSimon Glass } 726293d7fbdSSimon Glass 727293d7fbdSSimon Glass 728293d7fbdSSimon Glass free(fs->gdtable); 729293d7fbdSSimon Glass fs->gdtable = NULL; 730293d7fbdSSimon Glass fs->bgd = NULL; 731293d7fbdSSimon Glass /* 732293d7fbdSSimon Glass * reinitiliazed the global inode and 733293d7fbdSSimon Glass * block bitmap first execution check variables 734293d7fbdSSimon Glass */ 735293d7fbdSSimon Glass fs->first_pass_ibmap = 0; 736293d7fbdSSimon Glass fs->first_pass_bbmap = 0; 737293d7fbdSSimon Glass fs->curr_inode_no = 0; 738293d7fbdSSimon Glass fs->curr_blkno = 0; 739293d7fbdSSimon Glass } 740293d7fbdSSimon Glass 741293d7fbdSSimon Glass static int ext4fs_write_file(struct ext2_inode *file_inode, 742293d7fbdSSimon Glass int pos, unsigned int len, char *buf) 743293d7fbdSSimon Glass { 744293d7fbdSSimon Glass int i; 745293d7fbdSSimon Glass int blockcnt; 746293d7fbdSSimon Glass unsigned int filesize = __le32_to_cpu(file_inode->size); 747293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 74850ce4c07SEgbert Eich int log2blksz = fs->dev_desc->log2blksz; 74950ce4c07SEgbert Eich int log2_fs_blocksize = LOG2_BLOCK_SIZE(ext4fs_root) - log2blksz; 750293d7fbdSSimon Glass int previous_block_number = -1; 751293d7fbdSSimon Glass int delayed_start = 0; 752293d7fbdSSimon Glass int delayed_extent = 0; 753293d7fbdSSimon Glass int delayed_next = 0; 754293d7fbdSSimon Glass char *delayed_buf = NULL; 755293d7fbdSSimon Glass 756293d7fbdSSimon Glass /* Adjust len so it we can't read past the end of the file. */ 757293d7fbdSSimon Glass if (len > filesize) 758293d7fbdSSimon Glass len = filesize; 759293d7fbdSSimon Glass 760293d7fbdSSimon Glass blockcnt = ((len + pos) + fs->blksz - 1) / fs->blksz; 761293d7fbdSSimon Glass 762293d7fbdSSimon Glass for (i = pos / fs->blksz; i < blockcnt; i++) { 763293d7fbdSSimon Glass long int blknr; 764293d7fbdSSimon Glass int blockend = fs->blksz; 765293d7fbdSSimon Glass int skipfirst = 0; 766293d7fbdSSimon Glass blknr = read_allocated_block(file_inode, i); 767293d7fbdSSimon Glass if (blknr < 0) 768293d7fbdSSimon Glass return -1; 769293d7fbdSSimon Glass 77050ce4c07SEgbert Eich blknr = blknr << log2_fs_blocksize; 771293d7fbdSSimon Glass 772293d7fbdSSimon Glass if (blknr) { 773293d7fbdSSimon Glass if (previous_block_number != -1) { 774293d7fbdSSimon Glass if (delayed_next == blknr) { 775293d7fbdSSimon Glass delayed_extent += blockend; 77650ce4c07SEgbert Eich delayed_next += blockend >> log2blksz; 777293d7fbdSSimon Glass } else { /* spill */ 77850ce4c07SEgbert Eich put_ext4((uint64_t) 7790550870bSMa Haijun ((uint64_t)delayed_start << log2blksz), 780293d7fbdSSimon Glass delayed_buf, 781293d7fbdSSimon Glass (uint32_t) delayed_extent); 782293d7fbdSSimon Glass previous_block_number = blknr; 783293d7fbdSSimon Glass delayed_start = blknr; 784293d7fbdSSimon Glass delayed_extent = blockend; 785293d7fbdSSimon Glass delayed_buf = buf; 786293d7fbdSSimon Glass delayed_next = blknr + 78750ce4c07SEgbert Eich (blockend >> log2blksz); 788293d7fbdSSimon Glass } 789293d7fbdSSimon Glass } else { 790293d7fbdSSimon Glass previous_block_number = blknr; 791293d7fbdSSimon Glass delayed_start = blknr; 792293d7fbdSSimon Glass delayed_extent = blockend; 793293d7fbdSSimon Glass delayed_buf = buf; 794293d7fbdSSimon Glass delayed_next = blknr + 79550ce4c07SEgbert Eich (blockend >> log2blksz); 796293d7fbdSSimon Glass } 797293d7fbdSSimon Glass } else { 798293d7fbdSSimon Glass if (previous_block_number != -1) { 799293d7fbdSSimon Glass /* spill */ 8000550870bSMa Haijun put_ext4((uint64_t) ((uint64_t)delayed_start << 80150ce4c07SEgbert Eich log2blksz), 80250ce4c07SEgbert Eich delayed_buf, 803293d7fbdSSimon Glass (uint32_t) delayed_extent); 804293d7fbdSSimon Glass previous_block_number = -1; 805293d7fbdSSimon Glass } 806293d7fbdSSimon Glass memset(buf, 0, fs->blksz - skipfirst); 807293d7fbdSSimon Glass } 808293d7fbdSSimon Glass buf += fs->blksz - skipfirst; 809293d7fbdSSimon Glass } 810293d7fbdSSimon Glass if (previous_block_number != -1) { 811293d7fbdSSimon Glass /* spill */ 8120550870bSMa Haijun put_ext4((uint64_t) ((uint64_t)delayed_start << log2blksz), 813293d7fbdSSimon Glass delayed_buf, (uint32_t) delayed_extent); 814293d7fbdSSimon Glass previous_block_number = -1; 815293d7fbdSSimon Glass } 816293d7fbdSSimon Glass 817293d7fbdSSimon Glass return len; 818293d7fbdSSimon Glass } 819293d7fbdSSimon Glass 820293d7fbdSSimon Glass int ext4fs_write(const char *fname, unsigned char *buffer, 821293d7fbdSSimon Glass unsigned long sizebytes) 822293d7fbdSSimon Glass { 823293d7fbdSSimon Glass int ret = 0; 824293d7fbdSSimon Glass struct ext2_inode *file_inode = NULL; 825293d7fbdSSimon Glass unsigned char *inode_buffer = NULL; 826293d7fbdSSimon Glass int parent_inodeno; 827293d7fbdSSimon Glass int inodeno; 828293d7fbdSSimon Glass time_t timestamp = 0; 829293d7fbdSSimon Glass 830293d7fbdSSimon Glass uint64_t bytes_reqd_for_file; 831293d7fbdSSimon Glass unsigned int blks_reqd_for_file; 832293d7fbdSSimon Glass unsigned int blocks_remaining; 833293d7fbdSSimon Glass int existing_file_inodeno; 834293d7fbdSSimon Glass char *temp_ptr = NULL; 835293d7fbdSSimon Glass long int itable_blkno; 836293d7fbdSSimon Glass long int parent_itable_blkno; 837293d7fbdSSimon Glass long int blkoff; 838293d7fbdSSimon Glass struct ext2_sblock *sblock = &(ext4fs_root->sblock); 839293d7fbdSSimon Glass unsigned int inodes_per_block; 840293d7fbdSSimon Glass unsigned int ibmap_idx; 841293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 842293d7fbdSSimon Glass ALLOC_CACHE_ALIGN_BUFFER(char, filename, 256); 843293d7fbdSSimon Glass memset(filename, 0x00, sizeof(filename)); 844293d7fbdSSimon Glass 845293d7fbdSSimon Glass g_parent_inode = zalloc(sizeof(struct ext2_inode)); 846293d7fbdSSimon Glass if (!g_parent_inode) 847293d7fbdSSimon Glass goto fail; 848293d7fbdSSimon Glass 849293d7fbdSSimon Glass if (ext4fs_init() != 0) { 850293d7fbdSSimon Glass printf("error in File System init\n"); 851293d7fbdSSimon Glass return -1; 852293d7fbdSSimon Glass } 853293d7fbdSSimon Glass inodes_per_block = fs->blksz / fs->inodesz; 854293d7fbdSSimon Glass parent_inodeno = ext4fs_get_parent_inode_num(fname, filename, F_FILE); 855293d7fbdSSimon Glass if (parent_inodeno == -1) 856293d7fbdSSimon Glass goto fail; 857293d7fbdSSimon Glass if (ext4fs_iget(parent_inodeno, g_parent_inode)) 858293d7fbdSSimon Glass goto fail; 859293d7fbdSSimon Glass /* check if the filename is already present in root */ 860293d7fbdSSimon Glass existing_file_inodeno = ext4fs_filename_check(filename); 861293d7fbdSSimon Glass if (existing_file_inodeno != -1) { 862293d7fbdSSimon Glass ret = ext4fs_delete_file(existing_file_inodeno); 863293d7fbdSSimon Glass fs->first_pass_bbmap = 0; 864293d7fbdSSimon Glass fs->curr_blkno = 0; 865293d7fbdSSimon Glass 866293d7fbdSSimon Glass fs->first_pass_ibmap = 0; 867293d7fbdSSimon Glass fs->curr_inode_no = 0; 868293d7fbdSSimon Glass if (ret) 869293d7fbdSSimon Glass goto fail; 870293d7fbdSSimon Glass } 871293d7fbdSSimon Glass /* calucalate how many blocks required */ 872293d7fbdSSimon Glass bytes_reqd_for_file = sizebytes; 873293d7fbdSSimon Glass blks_reqd_for_file = lldiv(bytes_reqd_for_file, fs->blksz); 874293d7fbdSSimon Glass if (do_div(bytes_reqd_for_file, fs->blksz) != 0) { 875293d7fbdSSimon Glass blks_reqd_for_file++; 876293d7fbdSSimon Glass debug("total bytes for a file %u\n", blks_reqd_for_file); 877293d7fbdSSimon Glass } 878293d7fbdSSimon Glass blocks_remaining = blks_reqd_for_file; 879293d7fbdSSimon Glass /* test for available space in partition */ 880293d7fbdSSimon Glass if (fs->sb->free_blocks < blks_reqd_for_file) { 881293d7fbdSSimon Glass printf("Not enough space on partition !!!\n"); 882293d7fbdSSimon Glass goto fail; 883293d7fbdSSimon Glass } 884293d7fbdSSimon Glass 885293d7fbdSSimon Glass ext4fs_update_parent_dentry(filename, &inodeno, FILETYPE_REG); 886293d7fbdSSimon Glass /* prepare file inode */ 887293d7fbdSSimon Glass inode_buffer = zalloc(fs->inodesz); 888293d7fbdSSimon Glass if (!inode_buffer) 889293d7fbdSSimon Glass goto fail; 890293d7fbdSSimon Glass file_inode = (struct ext2_inode *)inode_buffer; 891293d7fbdSSimon Glass file_inode->mode = S_IFREG | S_IRWXU | 892293d7fbdSSimon Glass S_IRGRP | S_IROTH | S_IXGRP | S_IXOTH; 893293d7fbdSSimon Glass /* ToDo: Update correct time */ 894293d7fbdSSimon Glass file_inode->mtime = timestamp; 895293d7fbdSSimon Glass file_inode->atime = timestamp; 896293d7fbdSSimon Glass file_inode->ctime = timestamp; 897293d7fbdSSimon Glass file_inode->nlinks = 1; 898293d7fbdSSimon Glass file_inode->size = sizebytes; 899293d7fbdSSimon Glass 900293d7fbdSSimon Glass /* Allocate data blocks */ 901293d7fbdSSimon Glass ext4fs_allocate_blocks(file_inode, blocks_remaining, 902293d7fbdSSimon Glass &blks_reqd_for_file); 90350ce4c07SEgbert Eich file_inode->blockcnt = (blks_reqd_for_file * fs->blksz) >> 90450ce4c07SEgbert Eich fs->dev_desc->log2blksz; 905293d7fbdSSimon Glass 906293d7fbdSSimon Glass temp_ptr = zalloc(fs->blksz); 907293d7fbdSSimon Glass if (!temp_ptr) 908293d7fbdSSimon Glass goto fail; 909293d7fbdSSimon Glass ibmap_idx = inodeno / ext4fs_root->sblock.inodes_per_group; 910293d7fbdSSimon Glass inodeno--; 911293d7fbdSSimon Glass itable_blkno = __le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) + 912293d7fbdSSimon Glass (inodeno % __le32_to_cpu(sblock->inodes_per_group)) / 913293d7fbdSSimon Glass inodes_per_block; 914293d7fbdSSimon Glass blkoff = (inodeno % inodes_per_block) * fs->inodesz; 91504735e9cSFrederic Leroy ext4fs_devread((lbaint_t)itable_blkno * fs->sect_perblk, 0, fs->blksz, 91604735e9cSFrederic Leroy temp_ptr); 917293d7fbdSSimon Glass if (ext4fs_log_journal(temp_ptr, itable_blkno)) 918293d7fbdSSimon Glass goto fail; 919293d7fbdSSimon Glass 920293d7fbdSSimon Glass memcpy(temp_ptr + blkoff, inode_buffer, fs->inodesz); 921293d7fbdSSimon Glass if (ext4fs_put_metadata(temp_ptr, itable_blkno)) 922293d7fbdSSimon Glass goto fail; 923293d7fbdSSimon Glass /* copy the file content into data blocks */ 924293d7fbdSSimon Glass if (ext4fs_write_file(file_inode, 0, sizebytes, (char *)buffer) == -1) { 925293d7fbdSSimon Glass printf("Error in copying content\n"); 926293d7fbdSSimon Glass goto fail; 927293d7fbdSSimon Glass } 928293d7fbdSSimon Glass ibmap_idx = parent_inodeno / ext4fs_root->sblock.inodes_per_group; 929293d7fbdSSimon Glass parent_inodeno--; 930293d7fbdSSimon Glass parent_itable_blkno = __le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) + 931293d7fbdSSimon Glass (parent_inodeno % 932293d7fbdSSimon Glass __le32_to_cpu(sblock->inodes_per_group)) / inodes_per_block; 933293d7fbdSSimon Glass blkoff = (parent_inodeno % inodes_per_block) * fs->inodesz; 934293d7fbdSSimon Glass if (parent_itable_blkno != itable_blkno) { 935293d7fbdSSimon Glass memset(temp_ptr, '\0', fs->blksz); 93604735e9cSFrederic Leroy ext4fs_devread((lbaint_t)parent_itable_blkno * fs->sect_perblk, 937293d7fbdSSimon Glass 0, fs->blksz, temp_ptr); 938293d7fbdSSimon Glass if (ext4fs_log_journal(temp_ptr, parent_itable_blkno)) 939293d7fbdSSimon Glass goto fail; 940293d7fbdSSimon Glass 941293d7fbdSSimon Glass memcpy(temp_ptr + blkoff, g_parent_inode, 942293d7fbdSSimon Glass sizeof(struct ext2_inode)); 943293d7fbdSSimon Glass if (ext4fs_put_metadata(temp_ptr, parent_itable_blkno)) 944293d7fbdSSimon Glass goto fail; 945293d7fbdSSimon Glass free(temp_ptr); 946293d7fbdSSimon Glass } else { 947293d7fbdSSimon Glass /* 948293d7fbdSSimon Glass * If parent and child fall in same inode table block 949293d7fbdSSimon Glass * both should be kept in 1 buffer 950293d7fbdSSimon Glass */ 951293d7fbdSSimon Glass memcpy(temp_ptr + blkoff, g_parent_inode, 952293d7fbdSSimon Glass sizeof(struct ext2_inode)); 953293d7fbdSSimon Glass gd_index--; 954293d7fbdSSimon Glass if (ext4fs_put_metadata(temp_ptr, itable_blkno)) 955293d7fbdSSimon Glass goto fail; 956293d7fbdSSimon Glass free(temp_ptr); 957293d7fbdSSimon Glass } 958293d7fbdSSimon Glass ext4fs_update(); 959293d7fbdSSimon Glass ext4fs_deinit(); 960293d7fbdSSimon Glass 961293d7fbdSSimon Glass fs->first_pass_bbmap = 0; 962293d7fbdSSimon Glass fs->curr_blkno = 0; 963293d7fbdSSimon Glass fs->first_pass_ibmap = 0; 964293d7fbdSSimon Glass fs->curr_inode_no = 0; 965293d7fbdSSimon Glass free(inode_buffer); 966293d7fbdSSimon Glass free(g_parent_inode); 967293d7fbdSSimon Glass g_parent_inode = NULL; 968293d7fbdSSimon Glass 969293d7fbdSSimon Glass return 0; 970293d7fbdSSimon Glass fail: 971293d7fbdSSimon Glass ext4fs_deinit(); 972293d7fbdSSimon Glass free(inode_buffer); 973293d7fbdSSimon Glass free(g_parent_inode); 974293d7fbdSSimon Glass g_parent_inode = NULL; 975293d7fbdSSimon Glass 976293d7fbdSSimon Glass return -1; 977293d7fbdSSimon Glass } 978