Skip to content
Snippets Groups Projects
ext2fs.c 20.6 KiB
Newer Older
  • Learn to ignore specific revisions
  • Stefan Roese's avatar
    Stefan Roese committed
    /*
     * (C) Copyright 2004
     *  esd gmbh <www.esd-electronics.com>
     *  Reinhard Arlt <reinhard.arlt@esd-electronics.com>
     *
     *  based on code from grub2 fs/ext2.c and fs/fshelp.c by
     *
     *  GRUB  --  GRand Unified Bootloader
     *  Copyright (C) 2003, 2004  Free Software Foundation, Inc.
     *
     *  This program is free software; you can redistribute it and/or modify
     *  it under the terms of the GNU General Public License as published by
     *  the Free Software Foundation; either version 2 of the License, or
     *  (at your option) any later version.
     *
     *  This program is distributed in the hope that it will be useful,
     *  but WITHOUT ANY WARRANTY; without even the implied warranty of
     *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
     *  GNU General Public License for more details.
     *
     *  You should have received a copy of the GNU General Public License
     *  along with this program; if not, write to the Free Software
     *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
     */
    
    #include <common.h>
    
    #if (CONFIG_COMMANDS & CFG_CMD_EXT2)
    #include <ext2fs.h>
    #include <malloc.h>
    #include <asm/byteorder.h>
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    extern int ext2fs_devread (int sector, int byte_offset, int byte_len,
    			   char *buf);
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    /* Magic value used to identify an ext2 filesystem.  */
    #define	EXT2_MAGIC		0xEF53
    /* Amount of indirect blocks in an inode.  */
    #define INDIRECT_BLOCKS		12
    /* Maximum lenght of a pathname.  */
    #define EXT2_PATH_MAX		4096
    /* Maximum nesting of symlinks, used to prevent a loop.  */
    #define	EXT2_MAX_SYMLINKCNT	8
    
    /* Filetype used in directory entry.  */
    #define	FILETYPE_UNKNOWN	0
    #define	FILETYPE_REG		1
    #define	FILETYPE_DIRECTORY	2
    #define	FILETYPE_SYMLINK	7
    
    /* Filetype information as used in inodes.  */
    #define FILETYPE_INO_MASK	0170000
    #define FILETYPE_INO_REG	0100000
    #define FILETYPE_INO_DIRECTORY	0040000
    #define FILETYPE_INO_SYMLINK	0120000
    
    /* Bits used as offset in sector */
    #define DISK_SECTOR_BITS        9
    
    /* Log2 size of ext2 block in 512 blocks.  */
    #define LOG2_EXT2_BLOCK_SIZE(data) (__le32_to_cpu (data->sblock.log2_block_size) + 1)
    
    /* Log2 size of ext2 block in bytes.  */
    #define LOG2_BLOCK_SIZE(data)	   (__le32_to_cpu (data->sblock.log2_block_size) + 10)
    
    /* The size of an ext2 block in bytes.  */
    #define EXT2_BLOCK_SIZE(data)	   (1 << LOG2_BLOCK_SIZE(data))
    
    /* The ext2 superblock.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    struct ext2_sblock {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	uint32_t total_inodes;
    	uint32_t total_blocks;
    	uint32_t reserved_blocks;
    	uint32_t free_blocks;
    	uint32_t free_inodes;
    	uint32_t first_data_block;
    	uint32_t log2_block_size;
    	uint32_t log2_fragment_size;
    	uint32_t blocks_per_group;
    	uint32_t fragments_per_group;
    	uint32_t inodes_per_group;
    	uint32_t mtime;
    	uint32_t utime;
    	uint16_t mnt_count;
    	uint16_t max_mnt_count;
    	uint16_t magic;
    	uint16_t fs_state;
    	uint16_t error_handling;
    	uint16_t minor_revision_level;
    	uint32_t lastcheck;
    	uint32_t checkinterval;
    	uint32_t creator_os;
    	uint32_t revision_level;
    	uint16_t uid_reserved;
    	uint16_t gid_reserved;
    	uint32_t first_inode;
    	uint16_t inode_size;
    	uint16_t block_group_number;
    	uint32_t feature_compatibility;
    	uint32_t feature_incompat;
    	uint32_t feature_ro_compat;
    	uint32_t unique_id[4];
    	char volume_name[16];
    	char last_mounted_on[64];
    	uint32_t compression_info;
    };
    
    /* The ext2 blockgroup.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    struct ext2_block_group {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	uint32_t block_id;
    	uint32_t inode_id;
    	uint32_t inode_table_id;
    	uint16_t free_blocks;
    	uint16_t free_inodes;
    	uint16_t pad;
    	uint32_t reserved[3];
    };
    
    /* The ext2 inode.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    struct ext2_inode {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	uint16_t mode;
    	uint16_t uid;
    	uint32_t size;
    	uint32_t atime;
    	uint32_t ctime;
    	uint32_t mtime;
    	uint32_t dtime;
    	uint16_t gid;
    	uint16_t nlinks;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	uint32_t blockcnt;	/* Blocks of 512 bytes!! */
    
    Stefan Roese's avatar
    Stefan Roese committed
    	uint32_t flags;
    	uint32_t osd1;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	union {
    		struct datablocks {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			uint32_t dir_blocks[INDIRECT_BLOCKS];
    			uint32_t indir_block;
    			uint32_t double_indir_block;
    			uint32_t tripple_indir_block;
    		} blocks;
    		char symlink[60];
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	} b;
    
    Stefan Roese's avatar
    Stefan Roese committed
    	uint32_t version;
    	uint32_t acl;
    	uint32_t dir_acl;
    	uint32_t fragment_addr;
    	uint32_t osd2[3];
    };
    
    /* The header of an ext2 directory entry.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    struct ext2_dirent {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	uint32_t inode;
    	uint16_t direntlen;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	uint8_t namelen;
    	uint8_t filetype;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    struct ext2fs_node {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	struct ext2_data *data;
    	struct ext2_inode inode;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	int ino;
    	int inode_read;
    
    Stefan Roese's avatar
    Stefan Roese committed
    };
    
    /* Information about a "mounted" ext2 filesystem.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    struct ext2_data {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	struct ext2_sblock sblock;
    	struct ext2_inode *inode;
    	struct ext2fs_node diropen;
    };
    
    
    typedef struct ext2fs_node *ext2fs_node_t;
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    struct ext2_data *ext2fs_root = NULL;
    ext2fs_node_t ext2fs_file = NULL;
    int symlinknest = 0;
    uint32_t *indir1_block = NULL;
    int indir1_size = 0;
    int indir1_blkno = -1;
    uint32_t *indir2_block = NULL;
    int indir2_size = 0;
    int indir2_blkno = -1;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    
    static int ext2fs_blockgroup
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	(struct ext2_data *data, int group, struct ext2_block_group *blkgrp) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    #ifdef DEBUG
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	printf ("ext2fs read blockgroup\n");
    
    Stefan Roese's avatar
    Stefan Roese committed
    #endif
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	return (ext2fs_devread
    		(((__le32_to_cpu (data->sblock.first_data_block) +
    		   1) << LOG2_EXT2_BLOCK_SIZE (data)),
    		 group * sizeof (struct ext2_block_group),
    		 sizeof (struct ext2_block_group), (char *) blkgrp));
    
    Stefan Roese's avatar
    Stefan Roese committed
    }
    
    
    static int ext2fs_read_inode
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	(struct ext2_data *data, int ino, struct ext2_inode *inode) {
    	struct ext2_block_group blkgrp;
    	struct ext2_sblock *sblock = &data->sblock;
    	int inodes_per_block;
    	int status;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	unsigned int blkno;
    	unsigned int blkoff;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    	/* It is easier to calculate if the first inode is 0.  */
    	ino--;
    #ifdef DEBUG
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	printf ("ext2fs read inode %d\n", ino);
    
    Stefan Roese's avatar
    Stefan Roese committed
    #endif
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	status = ext2fs_blockgroup (data,
    				    ino /
    				    __le32_to_cpu (sblock->inodes_per_group),
    				    &blkgrp);
    	if (status == 0) {
    		return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    	}
    	inodes_per_block = EXT2_BLOCK_SIZE (data) / 128;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	blkno = (ino % __le32_to_cpu (sblock->inodes_per_group)) /
    		inodes_per_block;
    	blkoff = (ino % __le32_to_cpu (sblock->inodes_per_group)) %
    		inodes_per_block;
    
    Stefan Roese's avatar
    Stefan Roese committed
    #ifdef DEBUG
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	printf ("ext2fs read inode blkno %d blkoff %d\n", blkno, blkoff);
    
    Stefan Roese's avatar
    Stefan Roese committed
    #endif
    	/* Read the inode.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	status = ext2fs_devread (((__le32_to_cpu (blkgrp.inode_table_id) +
    				   blkno) << LOG2_EXT2_BLOCK_SIZE (data)),
    				 sizeof (struct ext2_inode) * blkoff,
    				 sizeof (struct ext2_inode), (char *) inode);
    	if (status == 0) {
    		return (0);
    	}
    	return (1);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    void ext2fs_free_node (ext2fs_node_t node, ext2fs_node_t currroot) {
    	if ((node != &ext2fs_root->diropen) && (node != currroot)) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		free (node);
    	}
    }
    
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    static int ext2fs_read_block (ext2fs_node_t node, int fileblock) {
    	struct ext2_data *data = node->data;
    	struct ext2_inode *inode = &node->inode;
    	int blknr;
    	int blksz = EXT2_BLOCK_SIZE (data);
    	int log2_blksz = LOG2_EXT2_BLOCK_SIZE (data);
    	int status;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    	/* Direct blocks.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (fileblock < INDIRECT_BLOCKS) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		blknr = __le32_to_cpu (inode->b.blocks.dir_blocks[fileblock]);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	}
    
    Stefan Roese's avatar
    Stefan Roese committed
    	/* Indirect.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	else if (fileblock < (INDIRECT_BLOCKS + (blksz / 4))) {
    		if (indir1_block == NULL) {
    			indir1_block = (uint32_t *) malloc (blksz);
    			if (indir1_block == NULL) {
    				printf ("** ext2fs read block (indir 1) malloc failed. **\n");
    				return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_size = blksz;
    
    Stefan Roese's avatar
    Stefan Roese committed
    			indir1_blkno = -1;
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (blksz != indir1_size) {
    			free (indir1_block);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			indir1_block = NULL;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_size = 0;
    
    Stefan Roese's avatar
    Stefan Roese committed
    			indir1_blkno = -1;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_block = (uint32_t *) malloc (blksz);
    			if (indir1_block == NULL) {
    				printf ("** ext2fs read block (indir 1) malloc failed. **\n");
    				return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_size = blksz;
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if ((__le32_to_cpu (inode->b.blocks.indir_block) <<
    		     log2_blksz) != indir1_blkno) {
    			status = ext2fs_devread (__le32_to_cpu(inode->b.blocks.indir_block) << log2_blksz,
    						 0, blksz,
    						 (char *) indir1_block);
    			if (status == 0) {
    				printf ("** ext2fs read block (indir 1) failed. **\n");
    				return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_blkno =
    				__le32_to_cpu (inode->b.blocks.
    					       indir_block) << log2_blksz;
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		blknr = __le32_to_cpu (indir1_block
    				       [fileblock - INDIRECT_BLOCKS]);
    
    Stefan Roese's avatar
    Stefan Roese committed
    	}
    	/* Double indirect.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	else if (fileblock <
    		 (INDIRECT_BLOCKS + (blksz / 4 * (blksz / 4 + 1)))) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		unsigned int perblock = blksz / 4;
    		unsigned int rblock = fileblock - (INDIRECT_BLOCKS
    						   + blksz / 4);
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (indir1_block == NULL) {
    			indir1_block = (uint32_t *) malloc (blksz);
    			if (indir1_block == NULL) {
    				printf ("** ext2fs read block (indir 2 1) malloc failed. **\n");
    				return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_size = blksz;
    
    Stefan Roese's avatar
    Stefan Roese committed
    			indir1_blkno = -1;
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (blksz != indir1_size) {
    			free (indir1_block);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			indir1_block = NULL;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_size = 0;
    
    Stefan Roese's avatar
    Stefan Roese committed
    			indir1_blkno = -1;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_block = (uint32_t *) malloc (blksz);
    			if (indir1_block == NULL) {
    				printf ("** ext2fs read block (indir 2 1) malloc failed. **\n");
    				return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_size = blksz;
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if ((__le32_to_cpu (inode->b.blocks.double_indir_block) <<
    		     log2_blksz) != indir1_blkno) {
    			status = ext2fs_devread (__le32_to_cpu(inode->b.blocks.double_indir_block) << log2_blksz,
    						0, blksz,
    						(char *) indir1_block);
    			if (status == 0) {
    				printf ("** ext2fs read block (indir 2 1) failed. **\n");
    				return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir1_blkno =
    				__le32_to_cpu (inode->b.blocks.double_indir_block) << log2_blksz;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (indir2_block == NULL) {
    			indir2_block = (uint32_t *) malloc (blksz);
    			if (indir2_block == NULL) {
    				printf ("** ext2fs read block (indir 2 2) malloc failed. **\n");
    				return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir2_size = blksz;
    
    Stefan Roese's avatar
    Stefan Roese committed
    			indir2_blkno = -1;
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (blksz != indir2_size) {
    			free (indir2_block);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			indir2_block = NULL;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir2_size = 0;
    
    Stefan Roese's avatar
    Stefan Roese committed
    			indir2_blkno = -1;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir2_block = (uint32_t *) malloc (blksz);
    			if (indir2_block == NULL) {
    				printf ("** ext2fs read block (indir 2 2) malloc failed. **\n");
    				return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir2_size = blksz;
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if ((__le32_to_cpu (indir1_block[rblock / perblock]) <<
    		     log2_blksz) != indir1_blkno) {
    			status = ext2fs_devread (__le32_to_cpu(indir1_block[rblock / perblock]) << log2_blksz,
    						 0, blksz,
    						 (char *) indir2_block);
    			if (status == 0) {
    				printf ("** ext2fs read block (indir 2 2) failed. **\n");
    				return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			indir2_blkno =
    				__le32_to_cpu (indir1_block[rblock / perblock]) << log2_blksz;
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		blknr = __le32_to_cpu (indir2_block[rblock % perblock]);
    
    Stefan Roese's avatar
    Stefan Roese committed
    	}
    	/* Tripple indirect.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	else {
    		printf ("** ext2fs doesn't support tripple indirect blocks. **\n");
    		return (-1);
    	}
    
    Stefan Roese's avatar
    Stefan Roese committed
    #ifdef DEBUG
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	printf ("ext2fs_read_block %08x\n", blknr);
    
    Stefan Roese's avatar
    Stefan Roese committed
    #endif
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	return (blknr);
    
    Stefan Roese's avatar
    Stefan Roese committed
    }
    
    
    int ext2fs_read_file
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	(ext2fs_node_t node, int pos, unsigned int len, char *buf) {
    	int i;
    	int blockcnt;
    	int log2blocksize = LOG2_EXT2_BLOCK_SIZE (node->data);
    	int blocksize = 1 << (log2blocksize + DISK_SECTOR_BITS);
    	unsigned int filesize = node->inode.size;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    	/* Adjust len so it we can't read past the end of the file.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (len > filesize) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		len = filesize;
    	}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	blockcnt = ((len + pos) + blocksize - 1) / blocksize;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	for (i = pos / blocksize; i < blockcnt; i++) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		int blknr;
    		int blockoff = pos % blocksize;
    		int blockend = blocksize;
    
    		int skipfirst = 0;
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		blknr = ext2fs_read_block (node, i);
    		if (blknr < 0) {
    			return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    		blknr = blknr << log2blocksize;
    
    		/* Last block.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (i == blockcnt - 1) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			blockend = (len + pos) % blocksize;
    
    			/* The last portion is exactly blocksize.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			if (!blockend) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    				blockend = blocksize;
    			}
    		}
    
    		/* First block.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (i == pos / blocksize) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			skipfirst = blockoff;
    			blockend -= skipfirst;
    		}
    
    		/* If the block number is 0 this block is not stored on disk but
    		   is zero filled instead.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (blknr) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			int status;
    
    			status = ext2fs_devread (blknr, skipfirst, blockend, buf);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			if (status == 0) {
    				return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		} else {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			memset (buf, blocksize - skipfirst, 0);
    		}
    		buf += blocksize - skipfirst;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	}
    	return (len);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    static int ext2fs_iterate_dir (ext2fs_node_t dir, char *name, ext2fs_node_t * fnode, int *ftype)
    
    Stefan Roese's avatar
    Stefan Roese committed
    {
    	unsigned int fpos = 0;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	int status;
    
    Stefan Roese's avatar
    Stefan Roese committed
    	struct ext2fs_node *diro = (struct ext2fs_node *) dir;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    
    
    Stefan Roese's avatar
    Stefan Roese committed
    #ifdef DEBUG
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (name != NULL)
    		printf ("Iterate dir %s\n", name);
    
    Stefan Roese's avatar
    Stefan Roese committed
    #endif /* of DEBUG */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (!diro->inode_read) {
    		status = ext2fs_read_inode (diro->data, diro->ino,
    					    &diro->inode);
    		if (status == 0) {
    			return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    	}
    	/* Search the file.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	while (fpos < __le32_to_cpu (diro->inode.size)) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		struct ext2_dirent dirent;
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		status = ext2fs_read_file (diro, fpos,
    					   sizeof (struct ext2_dirent),
    					   (char *) &dirent);
    		if (status < 1) {
    			return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (dirent.namelen != 0) {
    			char filename[dirent.namelen + 1];
    			ext2fs_node_t fdiro;
    			int type = FILETYPE_UNKNOWN;
    
    			status = ext2fs_read_file (diro,
    						   fpos + sizeof (struct ext2_dirent),
    						   dirent.namelen, filename);
    			if (status < 1) {
    				return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    			fdiro = malloc (sizeof (struct ext2fs_node));
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			if (!fdiro) {
    				return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    			fdiro->data = diro->data;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			fdiro->ino = __le32_to_cpu (dirent.inode);
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    			filename[dirent.namelen] = '\0';
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			if (dirent.filetype != FILETYPE_UNKNOWN) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    				fdiro->inode_read = 0;
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				if (dirent.filetype == FILETYPE_DIRECTORY) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    					type = FILETYPE_DIRECTORY;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				} else if (dirent.filetype ==
    					   FILETYPE_SYMLINK) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    					type = FILETYPE_SYMLINK;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				} else if (dirent.filetype == FILETYPE_REG) {
    					type = FILETYPE_REG;
    
    Stefan Roese's avatar
    Stefan Roese committed
    				}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			} else {
    
    Stefan Roese's avatar
    Stefan Roese committed
    				/* The filetype can not be read from the dirent, get it from inode */
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				status = ext2fs_read_inode (diro->data,
    							    __le32_to_cpu(dirent.inode),
    							    &fdiro->inode);
    				if (status == 0) {
    					free (fdiro);
    					return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    				}
    				fdiro->inode_read = 1;
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				if ((__le16_to_cpu (fdiro->inode.mode) &
    				     FILETYPE_INO_MASK) ==
    				    FILETYPE_INO_DIRECTORY) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    					type = FILETYPE_DIRECTORY;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				} else if ((__le16_to_cpu (fdiro->inode.mode)
    					    & FILETYPE_INO_MASK) ==
    					   FILETYPE_INO_SYMLINK) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    					type = FILETYPE_SYMLINK;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				} else if ((__le16_to_cpu (fdiro->inode.mode)
    					    & FILETYPE_INO_MASK) ==
    					   FILETYPE_INO_REG) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    					type = FILETYPE_REG;
    				}
    			}
    #ifdef DEBUG
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			printf ("iterate >%s<\n", filename);
    
    Stefan Roese's avatar
    Stefan Roese committed
    #endif /* of DEBUG */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			if ((name != NULL) && (fnode != NULL)
    			    && (ftype != NULL)) {
    				if (strcmp (filename, name) == 0) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    					*ftype = type;
    					*fnode = fdiro;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    					return (1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    				}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			} else {
    				if (fdiro->inode_read == 0) {
    					status = ext2fs_read_inode (diro->data,
    							    __le32_to_cpu (dirent.inode),
    							    &fdiro->inode);
    					if (status == 0) {
    						free (fdiro);
    						return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    					}
    					fdiro->inode_read = 1;
    				}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				switch (type) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    				case FILETYPE_DIRECTORY:
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    					printf ("<DIR> ");
    
    Stefan Roese's avatar
    Stefan Roese committed
    					break;
    				case FILETYPE_SYMLINK:
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    					printf ("<SYM> ");
    
    Stefan Roese's avatar
    Stefan Roese committed
    					break;
    				case FILETYPE_REG:
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    					printf ("      ");
    
    Stefan Roese's avatar
    Stefan Roese committed
    					break;
    				default:
    
    Stefan Roese's avatar
    Stefan Roese committed
    					break;
    				}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				printf ("%10d %s\n",
    					__le32_to_cpu (fdiro->inode.size),
    					filename);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			free (fdiro);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    		fpos += __le16_to_cpu (dirent.direntlen);
    	}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	return (0);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    static char *ext2fs_read_symlink (ext2fs_node_t node) {
    	char *symlink;
    
    Stefan Roese's avatar
    Stefan Roese committed
    	struct ext2fs_node *diro = node;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	int status;
    
    	if (!diro->inode_read) {
    		status = ext2fs_read_inode (diro->data, diro->ino,
    					    &diro->inode);
    		if (status == 0) {
    			return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    	}
    	symlink = malloc (__le32_to_cpu (diro->inode.size) + 1);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (!symlink) {
    		return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    	}
    	/* If the filesize of the symlink is bigger than
    	   60 the symlink is stored in a separate block,
    	   otherwise it is stored in the inode.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (__le32_to_cpu (diro->inode.size) <= 60) {
    		strncpy (symlink, diro->inode.b.symlink,
    			 __le32_to_cpu (diro->inode.size));
    	} else {
    		status = ext2fs_read_file (diro, 0,
    					   __le32_to_cpu (diro->inode.size),
    					   symlink);
    		if (status == 0) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			free (symlink);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    	}
    	symlink[__le32_to_cpu (diro->inode.size)] = '\0';
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	return (symlink);
    
    Stefan Roese's avatar
    Stefan Roese committed
    }
    
    
    int ext2fs_find_file1
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	(const char *currpath,
    	 ext2fs_node_t currroot, ext2fs_node_t * currfound, int *foundtype) {
    	char fpath[strlen (currpath) + 1];
    	char *name = fpath;
    	char *next;
    	int status;
    	int type = FILETYPE_DIRECTORY;
    	ext2fs_node_t currnode = currroot;
    	ext2fs_node_t oldnode = currroot;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    	strncpy (fpath, currpath, strlen (currpath) + 1);
    
    	/* Remove all leading slashes.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	while (*name == '/') {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		name++;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	}
    	if (!*name) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		*currfound = currnode;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		return (1);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	for (;;) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		int found;
    
    		/* Extract the actual part from the pathname.  */
    		next = strchr (name, '/');
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (next) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			/* Remove all leading slashes.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			while (*next == '/') {
    
    Stefan Roese's avatar
    Stefan Roese committed
    				*(next++) = '\0';
    			}
    		}
    
    		/* At this point it is expected that the current node is a directory, check if this is true.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (type != FILETYPE_DIRECTORY) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			ext2fs_free_node (currnode, currroot);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    
    		oldnode = currnode;
    
    		/* Iterate over the directory.  */
    		found = ext2fs_iterate_dir (currnode, name, &currnode, &type);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (found == 0) {
    			return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (found == -1) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			break;
    		}
    
    		/* Read in the symlink and follow it.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (type == FILETYPE_SYMLINK) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			char *symlink;
    
    			/* Test if the symlink does not loop.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			if (++symlinknest == 8) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    				ext2fs_free_node (currnode, currroot);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				ext2fs_free_node (oldnode, currroot);
    				return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    
    			symlink = ext2fs_read_symlink (currnode);
    			ext2fs_free_node (currnode, currroot);
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			if (!symlink) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    				ext2fs_free_node (oldnode, currroot);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    #ifdef DEBUG
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			printf ("Got symlink >%s<\n", symlink);
    
    Stefan Roese's avatar
    Stefan Roese committed
    #endif /* of DEBUG */
    			/* The symlink is an absolute path, go back to the root inode.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			if (symlink[0] == '/') {
    
    Stefan Roese's avatar
    Stefan Roese committed
    				ext2fs_free_node (oldnode, currroot);
    				oldnode = &ext2fs_root->diropen;
    			}
    
    			/* Lookup the node the symlink points to.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			status = ext2fs_find_file1 (symlink, oldnode,
    						    &currnode, &type);
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    			free (symlink);
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			if (status == 0) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    				ext2fs_free_node (oldnode, currroot);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    				return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    			}
    		}
    
    		ext2fs_free_node (oldnode, currroot);
    
    		/* Found the node!  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		if (!next || *next == '\0') {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			*currfound = currnode;
    			*foundtype = type;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    			return (1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		}
    		name = next;
    	}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    }
    
    
    int ext2fs_find_file
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	(const char *path,
    	 ext2fs_node_t rootnode, ext2fs_node_t * foundnode, int expecttype) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	int status;
    	int foundtype = FILETYPE_DIRECTORY;
    
    
    	symlinknest = 0;
    
    	if (!path) {
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    		return (0);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	status = ext2fs_find_file1 (path, rootnode, foundnode, &foundtype);
    	if (status == 0) {
    		return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    	}
    	/* Check if the node that was found was of the expected type.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if ((expecttype == FILETYPE_REG) && (foundtype != expecttype)) {
    		return (0);
    	} else if ((expecttype == FILETYPE_DIRECTORY)
    		   && (foundtype != expecttype)) {
    		return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    	}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	return (1);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    int ext2fs_ls (char *dirname) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	ext2fs_node_t dirnode;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	int status;
    
    	if (ext2fs_root == NULL) {
    		return (0);
    	}
    
    	status = ext2fs_find_file (dirname, &ext2fs_root->diropen, &dirnode,
    				   FILETYPE_DIRECTORY);
    	if (status != 1) {
    		printf ("** Can not find directory. **\n");
    		return (1);
    	}
    	ext2fs_iterate_dir (dirnode, NULL, NULL, NULL);
    	ext2fs_free_node (dirnode, &ext2fs_root->diropen);
    	return (0);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    int ext2fs_open (char *filename) {
    	ext2fs_node_t fdiro = NULL;
    	int status;
    	int len;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (ext2fs_root == NULL) {
    
    		return (-1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    	}
    	ext2fs_file = NULL;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	status = ext2fs_find_file (filename, &ext2fs_root->diropen, &fdiro,
    				   FILETYPE_REG);
    	if (status == 0) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		goto fail;
    	}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (!fdiro->inode_read) {
    		status = ext2fs_read_inode (fdiro->data, fdiro->ino,
    					    &fdiro->inode);
    		if (status == 0) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    			goto fail;
    		}
    	}
    	len = __le32_to_cpu (fdiro->inode.size);
    	ext2fs_file = fdiro;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	return (len);
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	ext2fs_free_node (fdiro, &ext2fs_root->diropen);
    
    	return (-1);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    int ext2fs_close (void
    	) {
    	if ((ext2fs_file != NULL) && (ext2fs_root != NULL)) {
    		ext2fs_free_node (ext2fs_file, &ext2fs_root->diropen);
    
    Stefan Roese's avatar
    Stefan Roese committed
    		ext2fs_file = NULL;
    	}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (ext2fs_root != NULL) {
    		free (ext2fs_root);
    		ext2fs_root = NULL;
    	}
    	if (indir1_block != NULL) {
    		free (indir1_block);
    		indir1_block = NULL;
    		indir1_size = 0;
    		indir1_blkno = -1;
    	}
    	if (indir2_block != NULL) {
    		free (indir2_block);
    		indir2_block = NULL;
    		indir2_size = 0;
    		indir2_blkno = -1;
    	}
    	return (0);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    int ext2fs_read (char *buf, unsigned len) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	int status;
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (ext2fs_root == NULL) {
    		return (0);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (ext2fs_file == NULL) {
    		return (0);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	status = ext2fs_read_file (ext2fs_file, 0, len, buf);
    	return (status);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    int ext2fs_mount (unsigned part_length) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    	struct ext2_data *data;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	int status;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    	data = malloc (sizeof (struct ext2_data));
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (!data) {
    		return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    	}
    	/* Read the superblock.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	status = ext2fs_devread (1 * 2, 0, sizeof (struct ext2_sblock),
    				 (char *) &data->sblock);
    	if (status == 0) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		goto fail;
    	}
    	/* Make sure this is an ext2 filesystem.  */
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (__le16_to_cpu (data->sblock.magic) != EXT2_MAGIC) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		goto fail;
    	}
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	data->diropen.data = data;
    	data->diropen.ino = 2;
    	data->diropen.inode_read = 1;
    	data->inode = &data->diropen.inode;
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    	status = ext2fs_read_inode (data, 2, data->inode);
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	if (status == 0) {
    
    Stefan Roese's avatar
    Stefan Roese committed
    		goto fail;
    	}
    
    	ext2fs_root = data;
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	return (1);
    
    Stefan Roese's avatar
    Stefan Roese committed
    
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    fail:
    	printf ("Failed to mount ext2 filesystem...\n");
    	free (data);
    
    Stefan Roese's avatar
    Stefan Roese committed
    	ext2fs_root = NULL;
    
    Wolfgang Denk's avatar
    Wolfgang Denk committed
    	return (0);
    
    Stefan Roese's avatar
    Stefan Roese committed
    }
    
    #endif /* CFG_CMD_EXT2FS */