1*518e2e1aSwdenk /* 2*518e2e1aSwdenk * (C) Copyright 2003 - 2004 3*518e2e1aSwdenk * Sysgo AG, <www.elinos.com>, Pavel Bartusek <pba@sysgo.com> 4*518e2e1aSwdenk * 5*518e2e1aSwdenk * This program is free software; you can redistribute it and/or modify 6*518e2e1aSwdenk * it under the terms of the GNU General Public License as published by 7*518e2e1aSwdenk * the Free Software Foundation; either version 2 of the License, or 8*518e2e1aSwdenk * (at your option) any later version. 9*518e2e1aSwdenk * 10*518e2e1aSwdenk * This program is distributed in the hope that it will be useful, 11*518e2e1aSwdenk * but WITHOUT ANY WARRANTY; without even the implied warranty of 12*518e2e1aSwdenk * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 13*518e2e1aSwdenk * GNU General Public License for more details. 14*518e2e1aSwdenk * 15*518e2e1aSwdenk * You should have received a copy of the GNU General Public License 16*518e2e1aSwdenk * along with this program; if not, write to the Free Software 17*518e2e1aSwdenk * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 18*518e2e1aSwdenk */ 19*518e2e1aSwdenk 20*518e2e1aSwdenk 21*518e2e1aSwdenk #include <common.h> 22*518e2e1aSwdenk #if (CONFIG_COMMANDS & CFG_CMD_REISER) 23*518e2e1aSwdenk 24*518e2e1aSwdenk #include <config.h> 25*518e2e1aSwdenk #include <reiserfs.h> 26*518e2e1aSwdenk 27*518e2e1aSwdenk #include "reiserfs_private.h" 28*518e2e1aSwdenk 29*518e2e1aSwdenk static block_dev_desc_t *reiserfs_block_dev_desc; 30*518e2e1aSwdenk static disk_partition_t part_info; 31*518e2e1aSwdenk 32*518e2e1aSwdenk 33*518e2e1aSwdenk int reiserfs_set_blk_dev(block_dev_desc_t *rbdd, int part) 34*518e2e1aSwdenk { 35*518e2e1aSwdenk reiserfs_block_dev_desc = rbdd; 36*518e2e1aSwdenk 37*518e2e1aSwdenk if (part == 0) { 38*518e2e1aSwdenk /* disk doesn't use partition table */ 39*518e2e1aSwdenk part_info.start = 0; 40*518e2e1aSwdenk part_info.size = rbdd->lba; 41*518e2e1aSwdenk part_info.blksz = rbdd->blksz; 42*518e2e1aSwdenk } else { 43*518e2e1aSwdenk if (get_partition_info (reiserfs_block_dev_desc, part, &part_info)) { 44*518e2e1aSwdenk return 0; 45*518e2e1aSwdenk } 46*518e2e1aSwdenk } 47*518e2e1aSwdenk return (part_info.size); 48*518e2e1aSwdenk } 49*518e2e1aSwdenk 50*518e2e1aSwdenk 51*518e2e1aSwdenk int reiserfs_devread (int sector, int byte_offset, int byte_len, char *buf) 52*518e2e1aSwdenk { 53*518e2e1aSwdenk char sec_buf[SECTOR_SIZE]; 54*518e2e1aSwdenk unsigned block_len; 55*518e2e1aSwdenk /* 56*518e2e1aSwdenk unsigned len = byte_len; 57*518e2e1aSwdenk u8 *start = buf; 58*518e2e1aSwdenk */ 59*518e2e1aSwdenk /* 60*518e2e1aSwdenk * Check partition boundaries 61*518e2e1aSwdenk */ 62*518e2e1aSwdenk if (sector < 0 63*518e2e1aSwdenk || ((sector + ((byte_offset + byte_len - 1) >> SECTOR_BITS)) 64*518e2e1aSwdenk >= part_info.size)) { 65*518e2e1aSwdenk // errnum = ERR_OUTSIDE_PART; 66*518e2e1aSwdenk printf (" ** reiserfs_devread() read outside partition\n"); 67*518e2e1aSwdenk return 0; 68*518e2e1aSwdenk } 69*518e2e1aSwdenk 70*518e2e1aSwdenk /* 71*518e2e1aSwdenk * Get the read to the beginning of a partition. 72*518e2e1aSwdenk */ 73*518e2e1aSwdenk sector += byte_offset >> SECTOR_BITS; 74*518e2e1aSwdenk byte_offset &= SECTOR_SIZE - 1; 75*518e2e1aSwdenk 76*518e2e1aSwdenk #if defined(DEBUG) 77*518e2e1aSwdenk printf (" <%d, %d, %d> ", sector, byte_offset, byte_len); 78*518e2e1aSwdenk #endif 79*518e2e1aSwdenk 80*518e2e1aSwdenk 81*518e2e1aSwdenk if (reiserfs_block_dev_desc == NULL) 82*518e2e1aSwdenk return 0; 83*518e2e1aSwdenk 84*518e2e1aSwdenk 85*518e2e1aSwdenk if (byte_offset != 0) { 86*518e2e1aSwdenk /* read first part which isn't aligned with start of sector */ 87*518e2e1aSwdenk if (reiserfs_block_dev_desc->block_read(reiserfs_block_dev_desc->dev, 88*518e2e1aSwdenk part_info.start+sector, 1, (unsigned long *)sec_buf) != 1) { 89*518e2e1aSwdenk printf (" ** reiserfs_devread() read error\n"); 90*518e2e1aSwdenk return 0; 91*518e2e1aSwdenk } 92*518e2e1aSwdenk memcpy(buf, sec_buf+byte_offset, min(SECTOR_SIZE-byte_offset, byte_len)); 93*518e2e1aSwdenk buf+=min(SECTOR_SIZE-byte_offset, byte_len); 94*518e2e1aSwdenk byte_len-=min(SECTOR_SIZE-byte_offset, byte_len); 95*518e2e1aSwdenk sector++; 96*518e2e1aSwdenk } 97*518e2e1aSwdenk 98*518e2e1aSwdenk /* read sector aligned part */ 99*518e2e1aSwdenk block_len = byte_len & ~(SECTOR_SIZE-1); 100*518e2e1aSwdenk if (reiserfs_block_dev_desc->block_read(reiserfs_block_dev_desc->dev, 101*518e2e1aSwdenk part_info.start+sector, block_len/SECTOR_SIZE, (unsigned long *)buf) != 102*518e2e1aSwdenk block_len/SECTOR_SIZE) { 103*518e2e1aSwdenk printf (" ** reiserfs_devread() read error - block\n"); 104*518e2e1aSwdenk return 0; 105*518e2e1aSwdenk } 106*518e2e1aSwdenk buf+=block_len; 107*518e2e1aSwdenk byte_len-=block_len; 108*518e2e1aSwdenk sector+= block_len/SECTOR_SIZE; 109*518e2e1aSwdenk 110*518e2e1aSwdenk if ( byte_len != 0 ) { 111*518e2e1aSwdenk /* read rest of data which are not in whole sector */ 112*518e2e1aSwdenk if (reiserfs_block_dev_desc->block_read(reiserfs_block_dev_desc->dev, 113*518e2e1aSwdenk part_info.start+sector, 1, (unsigned long *)sec_buf) != 1) { 114*518e2e1aSwdenk printf (" ** reiserfs_devread() read error - last part\n"); 115*518e2e1aSwdenk return 0; 116*518e2e1aSwdenk } 117*518e2e1aSwdenk memcpy(buf, sec_buf, byte_len); 118*518e2e1aSwdenk } 119*518e2e1aSwdenk 120*518e2e1aSwdenk return 1; 121*518e2e1aSwdenk } 122*518e2e1aSwdenk 123*518e2e1aSwdenk #endif /* CFG_CMD_REISERFS */ 124