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> 26cf92e05cSSimon Glass #include <memalign.h> 27293d7fbdSSimon Glass #include <linux/stat.h> 28293d7fbdSSimon Glass #include <div64.h> 29293d7fbdSSimon Glass #include "ext4_common.h" 30293d7fbdSSimon Glass 3158a9ecbaSMichael Walle static inline void ext4fs_sb_free_inodes_inc(struct ext2_sblock *sb) 3258a9ecbaSMichael Walle { 3358a9ecbaSMichael Walle sb->free_inodes = cpu_to_le32(le32_to_cpu(sb->free_inodes) + 1); 3458a9ecbaSMichael Walle } 3558a9ecbaSMichael Walle 3658a9ecbaSMichael Walle static inline void ext4fs_sb_free_blocks_inc(struct ext2_sblock *sb) 3758a9ecbaSMichael Walle { 3858a9ecbaSMichael Walle sb->free_blocks = cpu_to_le32(le32_to_cpu(sb->free_blocks) + 1); 3958a9ecbaSMichael Walle } 4058a9ecbaSMichael Walle 4158a9ecbaSMichael Walle static inline void ext4fs_bg_free_inodes_inc(struct ext2_block_group *bg) 4258a9ecbaSMichael Walle { 4358a9ecbaSMichael Walle bg->free_inodes = cpu_to_le16(le16_to_cpu(bg->free_inodes) + 1); 4458a9ecbaSMichael Walle } 4558a9ecbaSMichael Walle 4658a9ecbaSMichael Walle static inline void ext4fs_bg_free_blocks_inc(struct ext2_block_group *bg) 4758a9ecbaSMichael Walle { 4858a9ecbaSMichael Walle bg->free_blocks = cpu_to_le16(le16_to_cpu(bg->free_blocks) + 1); 4958a9ecbaSMichael Walle } 5058a9ecbaSMichael Walle 51293d7fbdSSimon Glass static void ext4fs_update(void) 52293d7fbdSSimon Glass { 53293d7fbdSSimon Glass short i; 54293d7fbdSSimon Glass ext4fs_update_journal(); 55293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 56293d7fbdSSimon Glass 57293d7fbdSSimon Glass /* update super block */ 58293d7fbdSSimon Glass put_ext4((uint64_t)(SUPERBLOCK_SIZE), 59293d7fbdSSimon Glass (struct ext2_sblock *)fs->sb, (uint32_t)SUPERBLOCK_SIZE); 60293d7fbdSSimon Glass 61293d7fbdSSimon Glass /* update block groups */ 62293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 6358a9ecbaSMichael Walle fs->bgd[i].bg_checksum = cpu_to_le16(ext4fs_checksum_update(i)); 6458a9ecbaSMichael Walle put_ext4((uint64_t)le32_to_cpu(fs->bgd[i].block_id) * fs->blksz, 65293d7fbdSSimon Glass fs->blk_bmaps[i], fs->blksz); 66293d7fbdSSimon Glass } 67293d7fbdSSimon Glass 68293d7fbdSSimon Glass /* update inode table groups */ 69293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 7058a9ecbaSMichael Walle put_ext4((uint64_t)le32_to_cpu(fs->bgd[i].inode_id) * fs->blksz, 71293d7fbdSSimon Glass fs->inode_bmaps[i], fs->blksz); 72293d7fbdSSimon Glass } 73293d7fbdSSimon Glass 74293d7fbdSSimon Glass /* update the block group descriptor table */ 750550870bSMa Haijun put_ext4((uint64_t)((uint64_t)fs->gdtable_blkno * (uint64_t)fs->blksz), 76293d7fbdSSimon Glass (struct ext2_block_group *)fs->gdtable, 77293d7fbdSSimon Glass (fs->blksz * fs->no_blk_pergdt)); 78293d7fbdSSimon Glass 79293d7fbdSSimon Glass ext4fs_dump_metadata(); 80293d7fbdSSimon Glass 81293d7fbdSSimon Glass gindex = 0; 82293d7fbdSSimon Glass gd_index = 0; 83293d7fbdSSimon Glass } 84293d7fbdSSimon Glass 85293d7fbdSSimon Glass int ext4fs_get_bgdtable(void) 86293d7fbdSSimon Glass { 87293d7fbdSSimon Glass int status; 88293d7fbdSSimon Glass int grp_desc_size; 89293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 90293d7fbdSSimon Glass grp_desc_size = sizeof(struct ext2_block_group); 91293d7fbdSSimon Glass fs->no_blk_pergdt = (fs->no_blkgrp * grp_desc_size) / fs->blksz; 92293d7fbdSSimon Glass if ((fs->no_blkgrp * grp_desc_size) % fs->blksz) 93293d7fbdSSimon Glass fs->no_blk_pergdt++; 94293d7fbdSSimon Glass 95293d7fbdSSimon Glass /* allocate memory for gdtable */ 96293d7fbdSSimon Glass fs->gdtable = zalloc(fs->blksz * fs->no_blk_pergdt); 97293d7fbdSSimon Glass if (!fs->gdtable) 98293d7fbdSSimon Glass return -ENOMEM; 99293d7fbdSSimon Glass /* read the group descriptor table */ 10004735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)fs->gdtable_blkno * fs->sect_perblk, 10104735e9cSFrederic Leroy 0, fs->blksz * fs->no_blk_pergdt, fs->gdtable); 102293d7fbdSSimon Glass if (status == 0) 103293d7fbdSSimon Glass goto fail; 104293d7fbdSSimon Glass 105293d7fbdSSimon Glass if (ext4fs_log_gdt(fs->gdtable)) { 106293d7fbdSSimon Glass printf("Error in ext4fs_log_gdt\n"); 107293d7fbdSSimon Glass return -1; 108293d7fbdSSimon Glass } 109293d7fbdSSimon Glass 110293d7fbdSSimon Glass return 0; 111293d7fbdSSimon Glass fail: 112293d7fbdSSimon Glass free(fs->gdtable); 113293d7fbdSSimon Glass fs->gdtable = NULL; 114293d7fbdSSimon Glass 115293d7fbdSSimon Glass return -1; 116293d7fbdSSimon Glass } 117293d7fbdSSimon Glass 118293d7fbdSSimon Glass static void delete_single_indirect_block(struct ext2_inode *inode) 119293d7fbdSSimon Glass { 120293d7fbdSSimon Glass struct ext2_block_group *bgd = NULL; 121293d7fbdSSimon Glass static int prev_bg_bmap_idx = -1; 12258a9ecbaSMichael Walle uint32_t blknr; 123293d7fbdSSimon Glass int remainder; 124293d7fbdSSimon Glass int bg_idx; 125293d7fbdSSimon Glass int status; 12658a9ecbaSMichael Walle uint32_t blk_per_grp = le32_to_cpu(ext4fs_root->sblock.blocks_per_group); 127293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 128293d7fbdSSimon Glass char *journal_buffer = zalloc(fs->blksz); 129293d7fbdSSimon Glass if (!journal_buffer) { 130293d7fbdSSimon Glass printf("No memory\n"); 131293d7fbdSSimon Glass return; 132293d7fbdSSimon Glass } 133293d7fbdSSimon Glass /* get block group descriptor table */ 134293d7fbdSSimon Glass bgd = (struct ext2_block_group *)fs->gdtable; 135293d7fbdSSimon Glass 136293d7fbdSSimon Glass /* deleting the single indirect block associated with inode */ 137293d7fbdSSimon Glass if (inode->b.blocks.indir_block != 0) { 13858a9ecbaSMichael Walle blknr = le32_to_cpu(inode->b.blocks.indir_block); 13958a9ecbaSMichael Walle debug("SIPB releasing %u\n", blknr); 140293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 14135dd055bSŁukasz Majewski if (fs->blksz == 1024) { 142293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 143293d7fbdSSimon Glass if (!remainder) 144293d7fbdSSimon Glass bg_idx--; 145293d7fbdSSimon Glass } 146293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx); 14758a9ecbaSMichael Walle ext4fs_bg_free_blocks_inc(&bgd[bg_idx]); 14858a9ecbaSMichael Walle ext4fs_sb_free_blocks_inc(fs->sb); 149293d7fbdSSimon Glass /* journal backup */ 150293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 15158a9ecbaSMichael Walle status = ext4fs_devread( 15258a9ecbaSMichael Walle (lbaint_t)le32_to_cpu(bgd[bg_idx].block_id) * 153293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 154293d7fbdSSimon Glass journal_buffer); 155293d7fbdSSimon Glass if (status == 0) 156293d7fbdSSimon Glass goto fail; 157293d7fbdSSimon Glass if (ext4fs_log_journal 15858a9ecbaSMichael Walle (journal_buffer, le32_to_cpu(bgd[bg_idx].block_id))) 159293d7fbdSSimon Glass goto fail; 160293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 161293d7fbdSSimon Glass } 162293d7fbdSSimon Glass } 163293d7fbdSSimon Glass fail: 164293d7fbdSSimon Glass free(journal_buffer); 165293d7fbdSSimon Glass } 166293d7fbdSSimon Glass 167293d7fbdSSimon Glass static void delete_double_indirect_block(struct ext2_inode *inode) 168293d7fbdSSimon Glass { 169293d7fbdSSimon Glass int i; 170293d7fbdSSimon Glass short status; 171293d7fbdSSimon Glass static int prev_bg_bmap_idx = -1; 17258a9ecbaSMichael Walle uint32_t blknr; 173293d7fbdSSimon Glass int remainder; 174293d7fbdSSimon Glass int bg_idx; 17558a9ecbaSMichael Walle uint32_t blk_per_grp = le32_to_cpu(ext4fs_root->sblock.blocks_per_group); 17658a9ecbaSMichael Walle __le32 *di_buffer = NULL; 17758a9ecbaSMichael Walle void *dib_start_addr = NULL; 178293d7fbdSSimon Glass struct ext2_block_group *bgd = NULL; 179293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 180293d7fbdSSimon Glass char *journal_buffer = zalloc(fs->blksz); 181293d7fbdSSimon Glass if (!journal_buffer) { 182293d7fbdSSimon Glass printf("No memory\n"); 183293d7fbdSSimon Glass return; 184293d7fbdSSimon Glass } 185293d7fbdSSimon Glass /* get the block group descriptor table */ 186293d7fbdSSimon Glass bgd = (struct ext2_block_group *)fs->gdtable; 187293d7fbdSSimon Glass 188293d7fbdSSimon Glass if (inode->b.blocks.double_indir_block != 0) { 189293d7fbdSSimon Glass di_buffer = zalloc(fs->blksz); 190293d7fbdSSimon Glass if (!di_buffer) { 191293d7fbdSSimon Glass printf("No memory\n"); 192293d7fbdSSimon Glass return; 193293d7fbdSSimon Glass } 19458a9ecbaSMichael Walle dib_start_addr = di_buffer; 19558a9ecbaSMichael Walle blknr = le32_to_cpu(inode->b.blocks.double_indir_block); 19604735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, 19704735e9cSFrederic Leroy fs->blksz, (char *)di_buffer); 198293d7fbdSSimon Glass for (i = 0; i < fs->blksz / sizeof(int); i++) { 199293d7fbdSSimon Glass if (*di_buffer == 0) 200293d7fbdSSimon Glass break; 201293d7fbdSSimon Glass 202293d7fbdSSimon Glass debug("DICB releasing %u\n", *di_buffer); 20358a9ecbaSMichael Walle bg_idx = le32_to_cpu(*di_buffer) / blk_per_grp; 20435dd055bSŁukasz Majewski if (fs->blksz == 1024) { 20558a9ecbaSMichael Walle remainder = le32_to_cpu(*di_buffer) % blk_per_grp; 206293d7fbdSSimon Glass if (!remainder) 207293d7fbdSSimon Glass bg_idx--; 208293d7fbdSSimon Glass } 20958a9ecbaSMichael Walle ext4fs_reset_block_bmap(le32_to_cpu(*di_buffer), 210293d7fbdSSimon Glass fs->blk_bmaps[bg_idx], bg_idx); 211293d7fbdSSimon Glass di_buffer++; 21258a9ecbaSMichael Walle ext4fs_bg_free_blocks_inc(&bgd[bg_idx]); 21358a9ecbaSMichael Walle ext4fs_sb_free_blocks_inc(fs->sb); 214293d7fbdSSimon Glass /* journal backup */ 215293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 21658a9ecbaSMichael Walle status = ext4fs_devread( 21758a9ecbaSMichael Walle (lbaint_t)le32_to_cpu(bgd[bg_idx].block_id) 218293d7fbdSSimon Glass * fs->sect_perblk, 0, 219293d7fbdSSimon Glass fs->blksz, 220293d7fbdSSimon Glass journal_buffer); 221293d7fbdSSimon Glass if (status == 0) 222293d7fbdSSimon Glass goto fail; 223293d7fbdSSimon Glass 224293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 22558a9ecbaSMichael Walle le32_to_cpu(bgd[bg_idx].block_id))) 226293d7fbdSSimon Glass goto fail; 227293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 228293d7fbdSSimon Glass } 229293d7fbdSSimon Glass } 230293d7fbdSSimon Glass 231293d7fbdSSimon Glass /* removing the parent double indirect block */ 23258a9ecbaSMichael Walle blknr = le32_to_cpu(inode->b.blocks.double_indir_block); 233293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 23435dd055bSŁukasz Majewski if (fs->blksz == 1024) { 235293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 236293d7fbdSSimon Glass if (!remainder) 237293d7fbdSSimon Glass bg_idx--; 238293d7fbdSSimon Glass } 239293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx); 24058a9ecbaSMichael Walle ext4fs_bg_free_blocks_inc(&bgd[bg_idx]); 24158a9ecbaSMichael Walle ext4fs_sb_free_blocks_inc(fs->sb); 242293d7fbdSSimon Glass /* journal backup */ 243293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 244293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 24558a9ecbaSMichael Walle status = ext4fs_devread((lbaint_t)le32_to_cpu(bgd[bg_idx].block_id) * 246293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 247293d7fbdSSimon Glass journal_buffer); 248293d7fbdSSimon Glass if (status == 0) 249293d7fbdSSimon Glass goto fail; 250293d7fbdSSimon Glass 251293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 25258a9ecbaSMichael Walle le32_to_cpu(bgd[bg_idx].block_id))) 253293d7fbdSSimon Glass goto fail; 254293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 255293d7fbdSSimon Glass } 25658a9ecbaSMichael Walle debug("DIPB releasing %d\n", blknr); 257293d7fbdSSimon Glass } 258293d7fbdSSimon Glass fail: 25958a9ecbaSMichael Walle free(dib_start_addr); 260293d7fbdSSimon Glass free(journal_buffer); 261293d7fbdSSimon Glass } 262293d7fbdSSimon Glass 263293d7fbdSSimon Glass static void delete_triple_indirect_block(struct ext2_inode *inode) 264293d7fbdSSimon Glass { 265293d7fbdSSimon Glass int i, j; 266293d7fbdSSimon Glass short status; 267293d7fbdSSimon Glass static int prev_bg_bmap_idx = -1; 26858a9ecbaSMichael Walle uint32_t blknr; 269293d7fbdSSimon Glass int remainder; 270293d7fbdSSimon Glass int bg_idx; 27158a9ecbaSMichael Walle uint32_t blk_per_grp = le32_to_cpu(ext4fs_root->sblock.blocks_per_group); 27258a9ecbaSMichael Walle __le32 *tigp_buffer = NULL; 27358a9ecbaSMichael Walle void *tib_start_addr = NULL; 27458a9ecbaSMichael Walle __le32 *tip_buffer = NULL; 27558a9ecbaSMichael Walle void *tipb_start_addr = NULL; 276293d7fbdSSimon Glass struct ext2_block_group *bgd = NULL; 277293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 278293d7fbdSSimon Glass char *journal_buffer = zalloc(fs->blksz); 279293d7fbdSSimon Glass if (!journal_buffer) { 280293d7fbdSSimon Glass printf("No memory\n"); 281293d7fbdSSimon Glass return; 282293d7fbdSSimon Glass } 283293d7fbdSSimon Glass /* get block group descriptor table */ 284293d7fbdSSimon Glass bgd = (struct ext2_block_group *)fs->gdtable; 285293d7fbdSSimon Glass 286293d7fbdSSimon Glass if (inode->b.blocks.triple_indir_block != 0) { 287293d7fbdSSimon Glass tigp_buffer = zalloc(fs->blksz); 288293d7fbdSSimon Glass if (!tigp_buffer) { 289293d7fbdSSimon Glass printf("No memory\n"); 290293d7fbdSSimon Glass return; 291293d7fbdSSimon Glass } 29258a9ecbaSMichael Walle tib_start_addr = tigp_buffer; 29358a9ecbaSMichael Walle blknr = le32_to_cpu(inode->b.blocks.triple_indir_block); 29404735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, 29504735e9cSFrederic Leroy fs->blksz, (char *)tigp_buffer); 296293d7fbdSSimon Glass for (i = 0; i < fs->blksz / sizeof(int); i++) { 297293d7fbdSSimon Glass if (*tigp_buffer == 0) 298293d7fbdSSimon Glass break; 299293d7fbdSSimon Glass debug("tigp buffer releasing %u\n", *tigp_buffer); 300293d7fbdSSimon Glass 301293d7fbdSSimon Glass tip_buffer = zalloc(fs->blksz); 302293d7fbdSSimon Glass if (!tip_buffer) 303293d7fbdSSimon Glass goto fail; 30458a9ecbaSMichael Walle tipb_start_addr = tip_buffer; 30558a9ecbaSMichael Walle status = ext4fs_devread((lbaint_t)le32_to_cpu(*tigp_buffer) * 306293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 307293d7fbdSSimon Glass (char *)tip_buffer); 308293d7fbdSSimon Glass for (j = 0; j < fs->blksz / sizeof(int); j++) { 30958a9ecbaSMichael Walle if (le32_to_cpu(*tip_buffer) == 0) 310293d7fbdSSimon Glass break; 31158a9ecbaSMichael Walle bg_idx = le32_to_cpu(*tip_buffer) / blk_per_grp; 31235dd055bSŁukasz Majewski if (fs->blksz == 1024) { 31358a9ecbaSMichael Walle remainder = le32_to_cpu(*tip_buffer) % blk_per_grp; 314293d7fbdSSimon Glass if (!remainder) 315293d7fbdSSimon Glass bg_idx--; 316293d7fbdSSimon Glass } 317293d7fbdSSimon Glass 31858a9ecbaSMichael Walle ext4fs_reset_block_bmap(le32_to_cpu(*tip_buffer), 319293d7fbdSSimon Glass fs->blk_bmaps[bg_idx], 320293d7fbdSSimon Glass bg_idx); 321293d7fbdSSimon Glass 322293d7fbdSSimon Glass tip_buffer++; 32358a9ecbaSMichael Walle ext4fs_bg_free_blocks_inc(&bgd[bg_idx]); 32458a9ecbaSMichael Walle ext4fs_sb_free_blocks_inc(fs->sb); 325293d7fbdSSimon Glass /* journal backup */ 326293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 327293d7fbdSSimon Glass status = 328293d7fbdSSimon Glass ext4fs_devread( 32958a9ecbaSMichael Walle (lbaint_t)le32_to_cpu(bgd[bg_idx].block_id) * 330293d7fbdSSimon Glass fs->sect_perblk, 0, 331293d7fbdSSimon Glass fs->blksz, 332293d7fbdSSimon Glass journal_buffer); 333293d7fbdSSimon Glass if (status == 0) 334293d7fbdSSimon Glass goto fail; 335293d7fbdSSimon Glass 336293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 33758a9ecbaSMichael Walle le32_to_cpu(bgd[bg_idx].block_id))) 338293d7fbdSSimon Glass goto fail; 339293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 340293d7fbdSSimon Glass } 341293d7fbdSSimon Glass } 342293d7fbdSSimon Glass free(tipb_start_addr); 343293d7fbdSSimon Glass tipb_start_addr = NULL; 344293d7fbdSSimon Glass 345293d7fbdSSimon Glass /* 346293d7fbdSSimon Glass * removing the grand parent blocks 347293d7fbdSSimon Glass * which is connected to inode 348293d7fbdSSimon Glass */ 34958a9ecbaSMichael Walle bg_idx = le32_to_cpu(*tigp_buffer) / blk_per_grp; 35035dd055bSŁukasz Majewski if (fs->blksz == 1024) { 35158a9ecbaSMichael Walle remainder = le32_to_cpu(*tigp_buffer) % blk_per_grp; 352293d7fbdSSimon Glass if (!remainder) 353293d7fbdSSimon Glass bg_idx--; 354293d7fbdSSimon Glass } 35558a9ecbaSMichael Walle ext4fs_reset_block_bmap(le32_to_cpu(*tigp_buffer), 356293d7fbdSSimon Glass fs->blk_bmaps[bg_idx], bg_idx); 357293d7fbdSSimon Glass 358293d7fbdSSimon Glass tigp_buffer++; 35958a9ecbaSMichael Walle ext4fs_bg_free_blocks_inc(&bgd[bg_idx]); 36058a9ecbaSMichael Walle ext4fs_sb_free_blocks_inc(fs->sb); 361293d7fbdSSimon Glass /* journal backup */ 362293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 363293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 364293d7fbdSSimon Glass status = 36558a9ecbaSMichael Walle ext4fs_devread( 36658a9ecbaSMichael Walle (lbaint_t)le32_to_cpu(bgd[bg_idx].block_id) * 367293d7fbdSSimon Glass fs->sect_perblk, 0, 368293d7fbdSSimon Glass fs->blksz, journal_buffer); 369293d7fbdSSimon Glass if (status == 0) 370293d7fbdSSimon Glass goto fail; 371293d7fbdSSimon Glass 372293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 37358a9ecbaSMichael Walle le32_to_cpu(bgd[bg_idx].block_id))) 374293d7fbdSSimon Glass goto fail; 375293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 376293d7fbdSSimon Glass } 377293d7fbdSSimon Glass } 378293d7fbdSSimon Glass 379293d7fbdSSimon Glass /* removing the grand parent triple indirect block */ 38058a9ecbaSMichael Walle blknr = le32_to_cpu(inode->b.blocks.triple_indir_block); 381293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 38235dd055bSŁukasz Majewski if (fs->blksz == 1024) { 383293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 384293d7fbdSSimon Glass if (!remainder) 385293d7fbdSSimon Glass bg_idx--; 386293d7fbdSSimon Glass } 387293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], bg_idx); 38858a9ecbaSMichael Walle ext4fs_bg_free_blocks_inc(&bgd[bg_idx]); 38958a9ecbaSMichael Walle ext4fs_sb_free_blocks_inc(fs->sb); 390293d7fbdSSimon Glass /* journal backup */ 391293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 392293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 39358a9ecbaSMichael Walle status = ext4fs_devread( 39458a9ecbaSMichael Walle (lbaint_t)le32_to_cpu(bgd[bg_idx].block_id) * 395293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, 396293d7fbdSSimon Glass journal_buffer); 397293d7fbdSSimon Glass if (status == 0) 398293d7fbdSSimon Glass goto fail; 399293d7fbdSSimon Glass 400293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 40158a9ecbaSMichael Walle le32_to_cpu(bgd[bg_idx].block_id))) 402293d7fbdSSimon Glass goto fail; 403293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 404293d7fbdSSimon Glass } 40558a9ecbaSMichael Walle debug("tigp buffer itself releasing %d\n", blknr); 406293d7fbdSSimon Glass } 407293d7fbdSSimon Glass fail: 408293d7fbdSSimon Glass free(tib_start_addr); 409293d7fbdSSimon Glass free(tipb_start_addr); 410293d7fbdSSimon Glass free(journal_buffer); 411293d7fbdSSimon Glass } 412293d7fbdSSimon Glass 413293d7fbdSSimon Glass static int ext4fs_delete_file(int inodeno) 414293d7fbdSSimon Glass { 415293d7fbdSSimon Glass struct ext2_inode inode; 416293d7fbdSSimon Glass short status; 417293d7fbdSSimon Glass int i; 418293d7fbdSSimon Glass int remainder; 419293d7fbdSSimon Glass long int blknr; 420293d7fbdSSimon Glass int bg_idx; 421293d7fbdSSimon Glass int ibmap_idx; 422293d7fbdSSimon Glass char *read_buffer = NULL; 423293d7fbdSSimon Glass char *start_block_address = NULL; 42458a9ecbaSMichael Walle uint32_t no_blocks; 425293d7fbdSSimon Glass 426293d7fbdSSimon Glass static int prev_bg_bmap_idx = -1; 427293d7fbdSSimon Glass unsigned int inodes_per_block; 42858a9ecbaSMichael Walle uint32_t blkno; 429293d7fbdSSimon Glass unsigned int blkoff; 43058a9ecbaSMichael Walle uint32_t blk_per_grp = le32_to_cpu(ext4fs_root->sblock.blocks_per_group); 43158a9ecbaSMichael Walle uint32_t inode_per_grp = le32_to_cpu(ext4fs_root->sblock.inodes_per_group); 432293d7fbdSSimon Glass struct ext2_inode *inode_buffer = NULL; 433293d7fbdSSimon Glass struct ext2_block_group *bgd = NULL; 434293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 435293d7fbdSSimon Glass char *journal_buffer = zalloc(fs->blksz); 436293d7fbdSSimon Glass if (!journal_buffer) 437293d7fbdSSimon Glass return -ENOMEM; 438293d7fbdSSimon Glass /* get the block group descriptor table */ 439293d7fbdSSimon Glass bgd = (struct ext2_block_group *)fs->gdtable; 440293d7fbdSSimon Glass status = ext4fs_read_inode(ext4fs_root, inodeno, &inode); 441293d7fbdSSimon Glass if (status == 0) 442293d7fbdSSimon Glass goto fail; 443293d7fbdSSimon Glass 444293d7fbdSSimon Glass /* read the block no allocated to a file */ 44558a9ecbaSMichael Walle no_blocks = le32_to_cpu(inode.size) / fs->blksz; 44658a9ecbaSMichael Walle if (le32_to_cpu(inode.size) % fs->blksz) 447293d7fbdSSimon Glass no_blocks++; 448293d7fbdSSimon Glass 449293d7fbdSSimon Glass if (le32_to_cpu(inode.flags) & EXT4_EXTENTS_FL) { 450293d7fbdSSimon Glass struct ext2fs_node *node_inode = 451293d7fbdSSimon Glass zalloc(sizeof(struct ext2fs_node)); 452293d7fbdSSimon Glass if (!node_inode) 453293d7fbdSSimon Glass goto fail; 454293d7fbdSSimon Glass node_inode->data = ext4fs_root; 455293d7fbdSSimon Glass node_inode->ino = inodeno; 456293d7fbdSSimon Glass node_inode->inode_read = 0; 457293d7fbdSSimon Glass memcpy(&(node_inode->inode), &inode, sizeof(struct ext2_inode)); 458293d7fbdSSimon Glass 459293d7fbdSSimon Glass for (i = 0; i < no_blocks; i++) { 460293d7fbdSSimon Glass blknr = read_allocated_block(&(node_inode->inode), i); 461293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 46235dd055bSŁukasz Majewski if (fs->blksz == 1024) { 463293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 464293d7fbdSSimon Glass if (!remainder) 465293d7fbdSSimon Glass bg_idx--; 466293d7fbdSSimon Glass } 467293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], 468293d7fbdSSimon Glass bg_idx); 469293d7fbdSSimon Glass debug("EXT4_EXTENTS Block releasing %ld: %d\n", 470293d7fbdSSimon Glass blknr, bg_idx); 471293d7fbdSSimon Glass 47258a9ecbaSMichael Walle ext4fs_bg_free_blocks_inc(&bgd[bg_idx]); 47358a9ecbaSMichael Walle ext4fs_sb_free_blocks_inc(fs->sb); 474293d7fbdSSimon Glass 475293d7fbdSSimon Glass /* journal backup */ 476293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 477293d7fbdSSimon Glass status = 47858a9ecbaSMichael Walle ext4fs_devread( 47958a9ecbaSMichael Walle (lbaint_t)le32_to_cpu(bgd[bg_idx].block_id) * 480293d7fbdSSimon Glass fs->sect_perblk, 0, 481293d7fbdSSimon Glass fs->blksz, journal_buffer); 482293d7fbdSSimon Glass if (status == 0) 483293d7fbdSSimon Glass goto fail; 484293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 48558a9ecbaSMichael Walle le32_to_cpu(bgd[bg_idx].block_id))) 486293d7fbdSSimon Glass goto fail; 487293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 488293d7fbdSSimon Glass } 489293d7fbdSSimon Glass } 490293d7fbdSSimon Glass if (node_inode) { 491293d7fbdSSimon Glass free(node_inode); 492293d7fbdSSimon Glass node_inode = NULL; 493293d7fbdSSimon Glass } 494293d7fbdSSimon Glass } else { 495293d7fbdSSimon Glass 496293d7fbdSSimon Glass delete_single_indirect_block(&inode); 497293d7fbdSSimon Glass delete_double_indirect_block(&inode); 498293d7fbdSSimon Glass delete_triple_indirect_block(&inode); 499293d7fbdSSimon Glass 500293d7fbdSSimon Glass /* read the block no allocated to a file */ 50158a9ecbaSMichael Walle no_blocks = le32_to_cpu(inode.size) / fs->blksz; 50258a9ecbaSMichael Walle if (le32_to_cpu(inode.size) % fs->blksz) 503293d7fbdSSimon Glass no_blocks++; 504293d7fbdSSimon Glass for (i = 0; i < no_blocks; i++) { 505293d7fbdSSimon Glass blknr = read_allocated_block(&inode, i); 506293d7fbdSSimon Glass bg_idx = blknr / blk_per_grp; 50735dd055bSŁukasz Majewski if (fs->blksz == 1024) { 508293d7fbdSSimon Glass remainder = blknr % blk_per_grp; 509293d7fbdSSimon Glass if (!remainder) 510293d7fbdSSimon Glass bg_idx--; 511293d7fbdSSimon Glass } 512293d7fbdSSimon Glass ext4fs_reset_block_bmap(blknr, fs->blk_bmaps[bg_idx], 513293d7fbdSSimon Glass bg_idx); 514293d7fbdSSimon Glass debug("ActualB releasing %ld: %d\n", blknr, bg_idx); 515293d7fbdSSimon Glass 51658a9ecbaSMichael Walle ext4fs_bg_free_blocks_inc(&bgd[bg_idx]); 51758a9ecbaSMichael Walle ext4fs_sb_free_blocks_inc(fs->sb); 518293d7fbdSSimon Glass /* journal backup */ 519293d7fbdSSimon Glass if (prev_bg_bmap_idx != bg_idx) { 520293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 52158a9ecbaSMichael Walle status = ext4fs_devread( 52258a9ecbaSMichael Walle (lbaint_t)le32_to_cpu(bgd[bg_idx].block_id) 523293d7fbdSSimon Glass * fs->sect_perblk, 524293d7fbdSSimon Glass 0, fs->blksz, 525293d7fbdSSimon Glass journal_buffer); 526293d7fbdSSimon Glass if (status == 0) 527293d7fbdSSimon Glass goto fail; 528293d7fbdSSimon Glass if (ext4fs_log_journal(journal_buffer, 52958a9ecbaSMichael Walle le32_to_cpu(bgd[bg_idx].block_id))) 530293d7fbdSSimon Glass goto fail; 531293d7fbdSSimon Glass prev_bg_bmap_idx = bg_idx; 532293d7fbdSSimon Glass } 533293d7fbdSSimon Glass } 534293d7fbdSSimon Glass } 535293d7fbdSSimon Glass 536293d7fbdSSimon Glass /* from the inode no to blockno */ 537293d7fbdSSimon Glass inodes_per_block = fs->blksz / fs->inodesz; 538293d7fbdSSimon Glass ibmap_idx = inodeno / inode_per_grp; 539293d7fbdSSimon Glass 540293d7fbdSSimon Glass /* get the block no */ 541293d7fbdSSimon Glass inodeno--; 5427f101be3SMichael Walle blkno = le32_to_cpu(bgd[ibmap_idx].inode_table_id) + 54358a9ecbaSMichael Walle (inodeno % inode_per_grp) / inodes_per_block; 544293d7fbdSSimon Glass 545293d7fbdSSimon Glass /* get the offset of the inode */ 546293d7fbdSSimon Glass blkoff = ((inodeno) % inodes_per_block) * fs->inodesz; 547293d7fbdSSimon Glass 548293d7fbdSSimon Glass /* read the block no containing the inode */ 549293d7fbdSSimon Glass read_buffer = zalloc(fs->blksz); 550293d7fbdSSimon Glass if (!read_buffer) 551293d7fbdSSimon Glass goto fail; 552293d7fbdSSimon Glass start_block_address = read_buffer; 55304735e9cSFrederic Leroy status = ext4fs_devread((lbaint_t)blkno * fs->sect_perblk, 554293d7fbdSSimon Glass 0, fs->blksz, read_buffer); 555293d7fbdSSimon Glass if (status == 0) 556293d7fbdSSimon Glass goto fail; 557293d7fbdSSimon Glass 558293d7fbdSSimon Glass if (ext4fs_log_journal(read_buffer, blkno)) 559293d7fbdSSimon Glass goto fail; 560293d7fbdSSimon Glass 561293d7fbdSSimon Glass read_buffer = read_buffer + blkoff; 562293d7fbdSSimon Glass inode_buffer = (struct ext2_inode *)read_buffer; 563293d7fbdSSimon Glass memset(inode_buffer, '\0', sizeof(struct ext2_inode)); 564293d7fbdSSimon Glass 565293d7fbdSSimon Glass /* write the inode to original position in inode table */ 566293d7fbdSSimon Glass if (ext4fs_put_metadata(start_block_address, blkno)) 567293d7fbdSSimon Glass goto fail; 568293d7fbdSSimon Glass 569293d7fbdSSimon Glass /* update the respective inode bitmaps */ 570293d7fbdSSimon Glass inodeno++; 571293d7fbdSSimon Glass ext4fs_reset_inode_bmap(inodeno, fs->inode_bmaps[ibmap_idx], ibmap_idx); 57258a9ecbaSMichael Walle ext4fs_bg_free_inodes_inc(&bgd[ibmap_idx]); 57358a9ecbaSMichael Walle ext4fs_sb_free_inodes_inc(fs->sb); 574293d7fbdSSimon Glass /* journal backup */ 575293d7fbdSSimon Glass memset(journal_buffer, '\0', fs->blksz); 57658a9ecbaSMichael Walle status = ext4fs_devread((lbaint_t)le32_to_cpu(bgd[ibmap_idx].inode_id) * 577293d7fbdSSimon Glass fs->sect_perblk, 0, fs->blksz, journal_buffer); 578293d7fbdSSimon Glass if (status == 0) 579293d7fbdSSimon Glass goto fail; 58058a9ecbaSMichael Walle if (ext4fs_log_journal(journal_buffer, le32_to_cpu(bgd[ibmap_idx].inode_id))) 581293d7fbdSSimon Glass goto fail; 582293d7fbdSSimon Glass 583293d7fbdSSimon Glass ext4fs_update(); 584293d7fbdSSimon Glass ext4fs_deinit(); 5858b454eeeSŁukasz Majewski ext4fs_reinit_global(); 586293d7fbdSSimon Glass 587293d7fbdSSimon Glass if (ext4fs_init() != 0) { 588293d7fbdSSimon Glass printf("error in File System init\n"); 589293d7fbdSSimon Glass goto fail; 590293d7fbdSSimon Glass } 591293d7fbdSSimon Glass 592293d7fbdSSimon Glass free(start_block_address); 593293d7fbdSSimon Glass free(journal_buffer); 594293d7fbdSSimon Glass 595293d7fbdSSimon Glass return 0; 596293d7fbdSSimon Glass fail: 597293d7fbdSSimon Glass free(start_block_address); 598293d7fbdSSimon Glass free(journal_buffer); 599293d7fbdSSimon Glass 600293d7fbdSSimon Glass return -1; 601293d7fbdSSimon Glass } 602293d7fbdSSimon Glass 603293d7fbdSSimon Glass int ext4fs_init(void) 604293d7fbdSSimon Glass { 605293d7fbdSSimon Glass short status; 606293d7fbdSSimon Glass int i; 60758a9ecbaSMichael Walle uint32_t real_free_blocks = 0; 608293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 609293d7fbdSSimon Glass 610293d7fbdSSimon Glass /* populate fs */ 611293d7fbdSSimon Glass fs->blksz = EXT2_BLOCK_SIZE(ext4fs_root); 612293d7fbdSSimon Glass fs->inodesz = INODE_SIZE_FILESYSTEM(ext4fs_root); 61350ce4c07SEgbert Eich fs->sect_perblk = fs->blksz >> fs->dev_desc->log2blksz; 614293d7fbdSSimon Glass 615293d7fbdSSimon Glass /* get the superblock */ 616293d7fbdSSimon Glass fs->sb = zalloc(SUPERBLOCK_SIZE); 617293d7fbdSSimon Glass if (!fs->sb) 618293d7fbdSSimon Glass return -ENOMEM; 61950ce4c07SEgbert Eich if (!ext4_read_superblock((char *)fs->sb)) 620293d7fbdSSimon Glass goto fail; 621293d7fbdSSimon Glass 622293d7fbdSSimon Glass /* init journal */ 623293d7fbdSSimon Glass if (ext4fs_init_journal()) 624293d7fbdSSimon Glass goto fail; 625293d7fbdSSimon Glass 626293d7fbdSSimon Glass /* get total no of blockgroups */ 627293d7fbdSSimon Glass fs->no_blkgrp = (uint32_t)ext4fs_div_roundup( 62858a9ecbaSMichael Walle le32_to_cpu(ext4fs_root->sblock.total_blocks) 62958a9ecbaSMichael Walle - le32_to_cpu(ext4fs_root->sblock.first_data_block), 63058a9ecbaSMichael Walle le32_to_cpu(ext4fs_root->sblock.blocks_per_group)); 631293d7fbdSSimon Glass 632293d7fbdSSimon Glass /* get the block group descriptor table */ 633293d7fbdSSimon Glass fs->gdtable_blkno = ((EXT2_MIN_BLOCK_SIZE == fs->blksz) + 1); 634293d7fbdSSimon Glass if (ext4fs_get_bgdtable() == -1) { 635293d7fbdSSimon Glass printf("Error in getting the block group descriptor table\n"); 636293d7fbdSSimon Glass goto fail; 637293d7fbdSSimon Glass } 638293d7fbdSSimon Glass fs->bgd = (struct ext2_block_group *)fs->gdtable; 639293d7fbdSSimon Glass 640293d7fbdSSimon Glass /* load all the available bitmap block of the partition */ 641293d7fbdSSimon Glass fs->blk_bmaps = zalloc(fs->no_blkgrp * sizeof(char *)); 642293d7fbdSSimon Glass if (!fs->blk_bmaps) 643293d7fbdSSimon Glass goto fail; 644293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 645293d7fbdSSimon Glass fs->blk_bmaps[i] = zalloc(fs->blksz); 646293d7fbdSSimon Glass if (!fs->blk_bmaps[i]) 647293d7fbdSSimon Glass goto fail; 648293d7fbdSSimon Glass } 649293d7fbdSSimon Glass 650293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 651293d7fbdSSimon Glass status = 65258a9ecbaSMichael Walle ext4fs_devread( 65358a9ecbaSMichael Walle (lbaint_t)le32_to_cpu(fs->bgd[i].block_id) * 65404735e9cSFrederic Leroy fs->sect_perblk, 0, 655293d7fbdSSimon Glass fs->blksz, (char *)fs->blk_bmaps[i]); 656293d7fbdSSimon Glass if (status == 0) 657293d7fbdSSimon Glass goto fail; 658293d7fbdSSimon Glass } 659293d7fbdSSimon Glass 660293d7fbdSSimon Glass /* load all the available inode bitmap of the partition */ 661293d7fbdSSimon Glass fs->inode_bmaps = zalloc(fs->no_blkgrp * sizeof(unsigned char *)); 662293d7fbdSSimon Glass if (!fs->inode_bmaps) 663293d7fbdSSimon Glass goto fail; 664293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 665293d7fbdSSimon Glass fs->inode_bmaps[i] = zalloc(fs->blksz); 666293d7fbdSSimon Glass if (!fs->inode_bmaps[i]) 667293d7fbdSSimon Glass goto fail; 668293d7fbdSSimon Glass } 669293d7fbdSSimon Glass 670293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 67158a9ecbaSMichael Walle status = ext4fs_devread( 67258a9ecbaSMichael Walle (lbaint_t)le32_to_cpu(fs->bgd[i].inode_id) * 67304735e9cSFrederic Leroy fs->sect_perblk, 674293d7fbdSSimon Glass 0, fs->blksz, 675293d7fbdSSimon Glass (char *)fs->inode_bmaps[i]); 676293d7fbdSSimon Glass if (status == 0) 677293d7fbdSSimon Glass goto fail; 678293d7fbdSSimon Glass } 679293d7fbdSSimon Glass 680293d7fbdSSimon Glass /* 681293d7fbdSSimon Glass * check filesystem consistency with free blocks of file system 682293d7fbdSSimon Glass * some time we observed that superblock freeblocks does not match 683293d7fbdSSimon Glass * with the blockgroups freeblocks when improper 684293d7fbdSSimon Glass * reboot of a linux kernel 685293d7fbdSSimon Glass */ 686293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) 68758a9ecbaSMichael Walle real_free_blocks = real_free_blocks + le16_to_cpu(fs->bgd[i].free_blocks); 68858a9ecbaSMichael Walle if (real_free_blocks != le32_to_cpu(fs->sb->free_blocks)) 68958a9ecbaSMichael Walle fs->sb->free_blocks = cpu_to_le32(real_free_blocks); 690293d7fbdSSimon Glass 691293d7fbdSSimon Glass return 0; 692293d7fbdSSimon Glass fail: 693293d7fbdSSimon Glass ext4fs_deinit(); 694293d7fbdSSimon Glass 695293d7fbdSSimon Glass return -1; 696293d7fbdSSimon Glass } 697293d7fbdSSimon Glass 698293d7fbdSSimon Glass void ext4fs_deinit(void) 699293d7fbdSSimon Glass { 700293d7fbdSSimon Glass int i; 701293d7fbdSSimon Glass struct ext2_inode inode_journal; 702293d7fbdSSimon Glass struct journal_superblock_t *jsb; 70358a9ecbaSMichael Walle uint32_t blknr; 704293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 70558a9ecbaSMichael Walle uint32_t new_feature_incompat; 706293d7fbdSSimon Glass 707293d7fbdSSimon Glass /* free journal */ 708293d7fbdSSimon Glass char *temp_buff = zalloc(fs->blksz); 709293d7fbdSSimon Glass if (temp_buff) { 710293d7fbdSSimon Glass ext4fs_read_inode(ext4fs_root, EXT2_JOURNAL_INO, 711293d7fbdSSimon Glass &inode_journal); 712293d7fbdSSimon Glass blknr = read_allocated_block(&inode_journal, 713293d7fbdSSimon Glass EXT2_JOURNAL_SUPERBLOCK); 71404735e9cSFrederic Leroy ext4fs_devread((lbaint_t)blknr * fs->sect_perblk, 0, fs->blksz, 715293d7fbdSSimon Glass temp_buff); 716293d7fbdSSimon Glass jsb = (struct journal_superblock_t *)temp_buff; 71758a9ecbaSMichael Walle jsb->s_start = 0; 7180550870bSMa Haijun put_ext4((uint64_t) ((uint64_t)blknr * (uint64_t)fs->blksz), 719293d7fbdSSimon Glass (struct journal_superblock_t *)temp_buff, fs->blksz); 720293d7fbdSSimon Glass free(temp_buff); 721293d7fbdSSimon Glass } 722293d7fbdSSimon Glass ext4fs_free_journal(); 723293d7fbdSSimon Glass 724293d7fbdSSimon Glass /* get the superblock */ 72550ce4c07SEgbert Eich ext4_read_superblock((char *)fs->sb); 72658a9ecbaSMichael Walle new_feature_incompat = le32_to_cpu(fs->sb->feature_incompat); 72758a9ecbaSMichael Walle new_feature_incompat &= ~EXT3_FEATURE_INCOMPAT_RECOVER; 72858a9ecbaSMichael Walle fs->sb->feature_incompat = cpu_to_le32(new_feature_incompat); 729293d7fbdSSimon Glass put_ext4((uint64_t)(SUPERBLOCK_SIZE), 730293d7fbdSSimon Glass (struct ext2_sblock *)fs->sb, (uint32_t)SUPERBLOCK_SIZE); 731293d7fbdSSimon Glass free(fs->sb); 732293d7fbdSSimon Glass fs->sb = NULL; 733293d7fbdSSimon Glass 734293d7fbdSSimon Glass if (fs->blk_bmaps) { 735293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 736293d7fbdSSimon Glass free(fs->blk_bmaps[i]); 737293d7fbdSSimon Glass fs->blk_bmaps[i] = NULL; 738293d7fbdSSimon Glass } 739293d7fbdSSimon Glass free(fs->blk_bmaps); 740293d7fbdSSimon Glass fs->blk_bmaps = NULL; 741293d7fbdSSimon Glass } 742293d7fbdSSimon Glass 743293d7fbdSSimon Glass if (fs->inode_bmaps) { 744293d7fbdSSimon Glass for (i = 0; i < fs->no_blkgrp; i++) { 745293d7fbdSSimon Glass free(fs->inode_bmaps[i]); 746293d7fbdSSimon Glass fs->inode_bmaps[i] = NULL; 747293d7fbdSSimon Glass } 748293d7fbdSSimon Glass free(fs->inode_bmaps); 749293d7fbdSSimon Glass fs->inode_bmaps = NULL; 750293d7fbdSSimon Glass } 751293d7fbdSSimon Glass 752293d7fbdSSimon Glass 753293d7fbdSSimon Glass free(fs->gdtable); 754293d7fbdSSimon Glass fs->gdtable = NULL; 755293d7fbdSSimon Glass fs->bgd = NULL; 756293d7fbdSSimon Glass /* 757293d7fbdSSimon Glass * reinitiliazed the global inode and 758293d7fbdSSimon Glass * block bitmap first execution check variables 759293d7fbdSSimon Glass */ 760293d7fbdSSimon Glass fs->first_pass_ibmap = 0; 761293d7fbdSSimon Glass fs->first_pass_bbmap = 0; 762293d7fbdSSimon Glass fs->curr_inode_no = 0; 763293d7fbdSSimon Glass fs->curr_blkno = 0; 764293d7fbdSSimon Glass } 765293d7fbdSSimon Glass 766293d7fbdSSimon Glass static int ext4fs_write_file(struct ext2_inode *file_inode, 767293d7fbdSSimon Glass int pos, unsigned int len, char *buf) 768293d7fbdSSimon Glass { 769293d7fbdSSimon Glass int i; 770293d7fbdSSimon Glass int blockcnt; 77158a9ecbaSMichael Walle uint32_t filesize = le32_to_cpu(file_inode->size); 772293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 77350ce4c07SEgbert Eich int log2blksz = fs->dev_desc->log2blksz; 77450ce4c07SEgbert Eich int log2_fs_blocksize = LOG2_BLOCK_SIZE(ext4fs_root) - log2blksz; 775293d7fbdSSimon Glass int previous_block_number = -1; 776293d7fbdSSimon Glass int delayed_start = 0; 777293d7fbdSSimon Glass int delayed_extent = 0; 778293d7fbdSSimon Glass int delayed_next = 0; 779293d7fbdSSimon Glass char *delayed_buf = NULL; 780293d7fbdSSimon Glass 781293d7fbdSSimon Glass /* Adjust len so it we can't read past the end of the file. */ 782293d7fbdSSimon Glass if (len > filesize) 783293d7fbdSSimon Glass len = filesize; 784293d7fbdSSimon Glass 785293d7fbdSSimon Glass blockcnt = ((len + pos) + fs->blksz - 1) / fs->blksz; 786293d7fbdSSimon Glass 787293d7fbdSSimon Glass for (i = pos / fs->blksz; i < blockcnt; i++) { 788293d7fbdSSimon Glass long int blknr; 789293d7fbdSSimon Glass int blockend = fs->blksz; 790293d7fbdSSimon Glass int skipfirst = 0; 791293d7fbdSSimon Glass blknr = read_allocated_block(file_inode, i); 792293d7fbdSSimon Glass if (blknr < 0) 793293d7fbdSSimon Glass return -1; 794293d7fbdSSimon Glass 79550ce4c07SEgbert Eich blknr = blknr << log2_fs_blocksize; 796293d7fbdSSimon Glass 797293d7fbdSSimon Glass if (blknr) { 798293d7fbdSSimon Glass if (previous_block_number != -1) { 799293d7fbdSSimon Glass if (delayed_next == blknr) { 800293d7fbdSSimon Glass delayed_extent += blockend; 80150ce4c07SEgbert Eich delayed_next += blockend >> log2blksz; 802293d7fbdSSimon Glass } else { /* spill */ 80350ce4c07SEgbert Eich put_ext4((uint64_t) 8040550870bSMa Haijun ((uint64_t)delayed_start << log2blksz), 805293d7fbdSSimon Glass delayed_buf, 806293d7fbdSSimon Glass (uint32_t) delayed_extent); 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 previous_block_number = blknr; 816293d7fbdSSimon Glass delayed_start = blknr; 817293d7fbdSSimon Glass delayed_extent = blockend; 818293d7fbdSSimon Glass delayed_buf = buf; 819293d7fbdSSimon Glass delayed_next = blknr + 82050ce4c07SEgbert Eich (blockend >> log2blksz); 821293d7fbdSSimon Glass } 822293d7fbdSSimon Glass } else { 823293d7fbdSSimon Glass if (previous_block_number != -1) { 824293d7fbdSSimon Glass /* spill */ 8250550870bSMa Haijun put_ext4((uint64_t) ((uint64_t)delayed_start << 82650ce4c07SEgbert Eich log2blksz), 82750ce4c07SEgbert Eich delayed_buf, 828293d7fbdSSimon Glass (uint32_t) delayed_extent); 829293d7fbdSSimon Glass previous_block_number = -1; 830293d7fbdSSimon Glass } 831293d7fbdSSimon Glass memset(buf, 0, fs->blksz - skipfirst); 832293d7fbdSSimon Glass } 833293d7fbdSSimon Glass buf += fs->blksz - skipfirst; 834293d7fbdSSimon Glass } 835293d7fbdSSimon Glass if (previous_block_number != -1) { 836293d7fbdSSimon Glass /* spill */ 8370550870bSMa Haijun put_ext4((uint64_t) ((uint64_t)delayed_start << log2blksz), 838293d7fbdSSimon Glass delayed_buf, (uint32_t) delayed_extent); 839293d7fbdSSimon Glass previous_block_number = -1; 840293d7fbdSSimon Glass } 841293d7fbdSSimon Glass 842293d7fbdSSimon Glass return len; 843293d7fbdSSimon Glass } 844293d7fbdSSimon Glass 845293d7fbdSSimon Glass int ext4fs_write(const char *fname, unsigned char *buffer, 846293d7fbdSSimon Glass unsigned long sizebytes) 847293d7fbdSSimon Glass { 848293d7fbdSSimon Glass int ret = 0; 849293d7fbdSSimon Glass struct ext2_inode *file_inode = NULL; 850293d7fbdSSimon Glass unsigned char *inode_buffer = NULL; 851293d7fbdSSimon Glass int parent_inodeno; 852293d7fbdSSimon Glass int inodeno; 853293d7fbdSSimon Glass time_t timestamp = 0; 854293d7fbdSSimon Glass 855293d7fbdSSimon Glass uint64_t bytes_reqd_for_file; 856293d7fbdSSimon Glass unsigned int blks_reqd_for_file; 857293d7fbdSSimon Glass unsigned int blocks_remaining; 858293d7fbdSSimon Glass int existing_file_inodeno; 859293d7fbdSSimon Glass char *temp_ptr = NULL; 860293d7fbdSSimon Glass long int itable_blkno; 861293d7fbdSSimon Glass long int parent_itable_blkno; 862293d7fbdSSimon Glass long int blkoff; 863293d7fbdSSimon Glass struct ext2_sblock *sblock = &(ext4fs_root->sblock); 864293d7fbdSSimon Glass unsigned int inodes_per_block; 865293d7fbdSSimon Glass unsigned int ibmap_idx; 866293d7fbdSSimon Glass struct ext_filesystem *fs = get_fs(); 867293d7fbdSSimon Glass ALLOC_CACHE_ALIGN_BUFFER(char, filename, 256); 86846a5707dSJeroen Hofstee memset(filename, 0x00, 256); 869293d7fbdSSimon Glass 870293d7fbdSSimon Glass g_parent_inode = zalloc(sizeof(struct ext2_inode)); 871293d7fbdSSimon Glass if (!g_parent_inode) 872293d7fbdSSimon Glass goto fail; 873293d7fbdSSimon Glass 874293d7fbdSSimon Glass if (ext4fs_init() != 0) { 875293d7fbdSSimon Glass printf("error in File System init\n"); 876293d7fbdSSimon Glass return -1; 877293d7fbdSSimon Glass } 878293d7fbdSSimon Glass inodes_per_block = fs->blksz / fs->inodesz; 879293d7fbdSSimon Glass parent_inodeno = ext4fs_get_parent_inode_num(fname, filename, F_FILE); 880293d7fbdSSimon Glass if (parent_inodeno == -1) 881293d7fbdSSimon Glass goto fail; 882293d7fbdSSimon Glass if (ext4fs_iget(parent_inodeno, g_parent_inode)) 883293d7fbdSSimon Glass goto fail; 884293d7fbdSSimon Glass /* check if the filename is already present in root */ 88576a29519SStefan Brüns existing_file_inodeno = ext4fs_filename_unlink(filename); 886293d7fbdSSimon Glass if (existing_file_inodeno != -1) { 887293d7fbdSSimon Glass ret = ext4fs_delete_file(existing_file_inodeno); 888293d7fbdSSimon Glass fs->first_pass_bbmap = 0; 889293d7fbdSSimon Glass fs->curr_blkno = 0; 890293d7fbdSSimon Glass 891293d7fbdSSimon Glass fs->first_pass_ibmap = 0; 892293d7fbdSSimon Glass fs->curr_inode_no = 0; 893293d7fbdSSimon Glass if (ret) 894293d7fbdSSimon Glass goto fail; 895293d7fbdSSimon Glass } 896293d7fbdSSimon Glass /* calucalate how many blocks required */ 897293d7fbdSSimon Glass bytes_reqd_for_file = sizebytes; 898293d7fbdSSimon Glass blks_reqd_for_file = lldiv(bytes_reqd_for_file, fs->blksz); 899293d7fbdSSimon Glass if (do_div(bytes_reqd_for_file, fs->blksz) != 0) { 900293d7fbdSSimon Glass blks_reqd_for_file++; 901293d7fbdSSimon Glass debug("total bytes for a file %u\n", blks_reqd_for_file); 902293d7fbdSSimon Glass } 903293d7fbdSSimon Glass blocks_remaining = blks_reqd_for_file; 904293d7fbdSSimon Glass /* test for available space in partition */ 90558a9ecbaSMichael Walle if (le32_to_cpu(fs->sb->free_blocks) < blks_reqd_for_file) { 906293d7fbdSSimon Glass printf("Not enough space on partition !!!\n"); 907293d7fbdSSimon Glass goto fail; 908293d7fbdSSimon Glass } 909293d7fbdSSimon Glass 910*a0d767e2SStefan Brüns inodeno = ext4fs_update_parent_dentry(filename, FILETYPE_REG); 911*a0d767e2SStefan Brüns if (inodeno == -1) 912*a0d767e2SStefan Brüns goto fail; 913293d7fbdSSimon Glass /* prepare file inode */ 914293d7fbdSSimon Glass inode_buffer = zalloc(fs->inodesz); 915293d7fbdSSimon Glass if (!inode_buffer) 916293d7fbdSSimon Glass goto fail; 917293d7fbdSSimon Glass file_inode = (struct ext2_inode *)inode_buffer; 91858a9ecbaSMichael Walle file_inode->mode = cpu_to_le16(S_IFREG | S_IRWXU | 91958a9ecbaSMichael Walle S_IRGRP | S_IROTH | S_IXGRP | S_IXOTH); 920293d7fbdSSimon Glass /* ToDo: Update correct time */ 92158a9ecbaSMichael Walle file_inode->mtime = cpu_to_le32(timestamp); 92258a9ecbaSMichael Walle file_inode->atime = cpu_to_le32(timestamp); 92358a9ecbaSMichael Walle file_inode->ctime = cpu_to_le32(timestamp); 92458a9ecbaSMichael Walle file_inode->nlinks = cpu_to_le16(1); 92558a9ecbaSMichael Walle file_inode->size = cpu_to_le32(sizebytes); 926293d7fbdSSimon Glass 927293d7fbdSSimon Glass /* Allocate data blocks */ 928293d7fbdSSimon Glass ext4fs_allocate_blocks(file_inode, blocks_remaining, 929293d7fbdSSimon Glass &blks_reqd_for_file); 93058a9ecbaSMichael Walle file_inode->blockcnt = cpu_to_le32((blks_reqd_for_file * fs->blksz) >> 93158a9ecbaSMichael Walle fs->dev_desc->log2blksz); 932293d7fbdSSimon Glass 933293d7fbdSSimon Glass temp_ptr = zalloc(fs->blksz); 934293d7fbdSSimon Glass if (!temp_ptr) 935293d7fbdSSimon Glass goto fail; 93658a9ecbaSMichael Walle ibmap_idx = inodeno / le32_to_cpu(ext4fs_root->sblock.inodes_per_group); 937293d7fbdSSimon Glass inodeno--; 9387f101be3SMichael Walle itable_blkno = le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) + 9397f101be3SMichael Walle (inodeno % le32_to_cpu(sblock->inodes_per_group)) / 940293d7fbdSSimon Glass inodes_per_block; 941293d7fbdSSimon Glass blkoff = (inodeno % inodes_per_block) * fs->inodesz; 94204735e9cSFrederic Leroy ext4fs_devread((lbaint_t)itable_blkno * fs->sect_perblk, 0, fs->blksz, 94304735e9cSFrederic Leroy temp_ptr); 944293d7fbdSSimon Glass if (ext4fs_log_journal(temp_ptr, itable_blkno)) 945293d7fbdSSimon Glass goto fail; 946293d7fbdSSimon Glass 947293d7fbdSSimon Glass memcpy(temp_ptr + blkoff, inode_buffer, fs->inodesz); 948293d7fbdSSimon Glass if (ext4fs_put_metadata(temp_ptr, itable_blkno)) 949293d7fbdSSimon Glass goto fail; 950293d7fbdSSimon Glass /* copy the file content into data blocks */ 951293d7fbdSSimon Glass if (ext4fs_write_file(file_inode, 0, sizebytes, (char *)buffer) == -1) { 952293d7fbdSSimon Glass printf("Error in copying content\n"); 953293d7fbdSSimon Glass goto fail; 954293d7fbdSSimon Glass } 95558a9ecbaSMichael Walle ibmap_idx = parent_inodeno / le32_to_cpu(ext4fs_root->sblock.inodes_per_group); 956293d7fbdSSimon Glass parent_inodeno--; 9577f101be3SMichael Walle parent_itable_blkno = le32_to_cpu(fs->bgd[ibmap_idx].inode_table_id) + 958293d7fbdSSimon Glass (parent_inodeno % 9597f101be3SMichael Walle le32_to_cpu(sblock->inodes_per_group)) / inodes_per_block; 960293d7fbdSSimon Glass blkoff = (parent_inodeno % inodes_per_block) * fs->inodesz; 961293d7fbdSSimon Glass if (parent_itable_blkno != itable_blkno) { 962293d7fbdSSimon Glass memset(temp_ptr, '\0', fs->blksz); 96304735e9cSFrederic Leroy ext4fs_devread((lbaint_t)parent_itable_blkno * fs->sect_perblk, 964293d7fbdSSimon Glass 0, fs->blksz, temp_ptr); 965293d7fbdSSimon Glass if (ext4fs_log_journal(temp_ptr, parent_itable_blkno)) 966293d7fbdSSimon Glass goto fail; 967293d7fbdSSimon Glass 968293d7fbdSSimon Glass memcpy(temp_ptr + blkoff, g_parent_inode, 969293d7fbdSSimon Glass sizeof(struct ext2_inode)); 970293d7fbdSSimon Glass if (ext4fs_put_metadata(temp_ptr, parent_itable_blkno)) 971293d7fbdSSimon Glass goto fail; 972293d7fbdSSimon Glass free(temp_ptr); 973293d7fbdSSimon Glass } else { 974293d7fbdSSimon Glass /* 975293d7fbdSSimon Glass * If parent and child fall in same inode table block 976293d7fbdSSimon Glass * both should be kept in 1 buffer 977293d7fbdSSimon Glass */ 978293d7fbdSSimon Glass memcpy(temp_ptr + blkoff, g_parent_inode, 979293d7fbdSSimon Glass sizeof(struct ext2_inode)); 980293d7fbdSSimon Glass gd_index--; 981293d7fbdSSimon Glass if (ext4fs_put_metadata(temp_ptr, itable_blkno)) 982293d7fbdSSimon Glass goto fail; 983293d7fbdSSimon Glass free(temp_ptr); 984293d7fbdSSimon Glass } 985293d7fbdSSimon Glass ext4fs_update(); 986293d7fbdSSimon Glass ext4fs_deinit(); 987293d7fbdSSimon Glass 988293d7fbdSSimon Glass fs->first_pass_bbmap = 0; 989293d7fbdSSimon Glass fs->curr_blkno = 0; 990293d7fbdSSimon Glass fs->first_pass_ibmap = 0; 991293d7fbdSSimon Glass fs->curr_inode_no = 0; 992293d7fbdSSimon Glass free(inode_buffer); 993293d7fbdSSimon Glass free(g_parent_inode); 994293d7fbdSSimon Glass g_parent_inode = NULL; 995293d7fbdSSimon Glass 996293d7fbdSSimon Glass return 0; 997293d7fbdSSimon Glass fail: 998293d7fbdSSimon Glass ext4fs_deinit(); 999293d7fbdSSimon Glass free(inode_buffer); 1000293d7fbdSSimon Glass free(g_parent_inode); 1001293d7fbdSSimon Glass g_parent_inode = NULL; 1002293d7fbdSSimon Glass 1003293d7fbdSSimon Glass return -1; 1004293d7fbdSSimon Glass } 10059f12cd0eSSuriyan Ramasami 10069f12cd0eSSuriyan Ramasami int ext4_write_file(const char *filename, void *buf, loff_t offset, 10079f12cd0eSSuriyan Ramasami loff_t len, loff_t *actwrite) 10089f12cd0eSSuriyan Ramasami { 10099f12cd0eSSuriyan Ramasami int ret; 10109f12cd0eSSuriyan Ramasami 10119f12cd0eSSuriyan Ramasami if (offset != 0) { 10129f12cd0eSSuriyan Ramasami printf("** Cannot support non-zero offset **\n"); 10139f12cd0eSSuriyan Ramasami return -1; 10149f12cd0eSSuriyan Ramasami } 10159f12cd0eSSuriyan Ramasami 10169f12cd0eSSuriyan Ramasami ret = ext4fs_write(filename, buf, len); 10179f12cd0eSSuriyan Ramasami if (ret) { 10189f12cd0eSSuriyan Ramasami printf("** Error ext4fs_write() **\n"); 10199f12cd0eSSuriyan Ramasami goto fail; 10209f12cd0eSSuriyan Ramasami } 10219f12cd0eSSuriyan Ramasami 102222b7509eSPrzemyslaw Marczak *actwrite = len; 102322b7509eSPrzemyslaw Marczak 10249f12cd0eSSuriyan Ramasami return 0; 10259f12cd0eSSuriyan Ramasami 10269f12cd0eSSuriyan Ramasami fail: 102722b7509eSPrzemyslaw Marczak *actwrite = 0; 10289f12cd0eSSuriyan Ramasami 10299f12cd0eSSuriyan Ramasami return -1; 10309f12cd0eSSuriyan Ramasami } 1031