Blame view

fs/zfs/dev.c 2.7 KB
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
1
2
3
4
5
6
7
  /*
   *
   *	based on code of fs/reiserfs/dev.c by
   *
   *	(C) Copyright 2003 - 2004
   *	Sysgo AG, <www.elinos.com>, Pavel Bartusek <pba@sysgo.com>
   *
1a4596601   Wolfgang Denk   Add GPL-2.0+ SPDX...
8
   * SPDX-License-Identifier:	GPL-2.0+
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
9
10
11
12
13
14
15
16
   */
  
  
  #include <common.h>
  #include <config.h>
  #include <zfs_common.h>
  
  static block_dev_desc_t *zfs_block_dev_desc;
412045704   Rob Herring   cmd_zfs: use comm...
17
  static disk_partition_t *part_info;
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
18

412045704   Rob Herring   cmd_zfs: use comm...
19
  void zfs_set_blk_dev(block_dev_desc_t *rbdd, disk_partition_t *info)
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
20
21
  {
  	zfs_block_dev_desc = rbdd;
412045704   Rob Herring   cmd_zfs: use comm...
22
  	part_info = info;
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
23
24
25
26
27
28
29
30
31
32
33
34
35
36
  }
  
  /* err */
  int zfs_devread(int sector, int byte_offset, int byte_len, char *buf)
  {
  	short sec_buffer[SECTOR_SIZE/sizeof(short)];
  	char *sec_buf = (char *)sec_buffer;
  	unsigned block_len;
  
  	/*
  	 *	Check partition boundaries
  	 */
  	if ((sector < 0) ||
  		((sector + ((byte_offset + byte_len - 1) >> SECTOR_BITS)) >=
412045704   Rob Herring   cmd_zfs: use comm...
37
  		 part_info->size)) {
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
  		/*		errnum = ERR_OUTSIDE_PART; */
  		printf(" ** zfs_devread() read outside partition sector %d
  ", sector);
  		return 1;
  	}
  
  	/*
  	 *	Get the read to the beginning of a partition.
  	 */
  	sector += byte_offset >> SECTOR_BITS;
  	byte_offset &= SECTOR_SIZE - 1;
  
  	debug(" <%d, %d, %d>
  ", sector, byte_offset, byte_len);
  
  	if (zfs_block_dev_desc == NULL) {
  		printf("** Invalid Block Device Descriptor (NULL)
  ");
  		return 1;
  	}
  
  	if (byte_offset != 0) {
  		/* read first part which isn't aligned with start of sector */
  		if (zfs_block_dev_desc->block_read(zfs_block_dev_desc->dev,
412045704   Rob Herring   cmd_zfs: use comm...
62
63
  			part_info->start + sector, 1,
  			(unsigned long *)sec_buf) != 1) {
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
  			printf(" ** zfs_devread() read error **
  ");
  			return 1;
  		}
  		memcpy(buf, sec_buf + byte_offset,
  			   min(SECTOR_SIZE - byte_offset, byte_len));
  		buf += min(SECTOR_SIZE - byte_offset, byte_len);
  		byte_len -= min(SECTOR_SIZE - byte_offset, byte_len);
  		sector++;
  	}
  
  	if (byte_len == 0)
  		return 0;
  
  	/*	read sector aligned part */
  	block_len = byte_len & ~(SECTOR_SIZE - 1);
  
  	if (block_len == 0) {
  		u8 p[SECTOR_SIZE];
  
  		block_len = SECTOR_SIZE;
  		zfs_block_dev_desc->block_read(zfs_block_dev_desc->dev,
412045704   Rob Herring   cmd_zfs: use comm...
86
87
  			part_info->start + sector,
  			1, (unsigned long *)p);
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
88
89
90
91
92
  		memcpy(buf, p, byte_len);
  		return 0;
  	}
  
  	if (zfs_block_dev_desc->block_read(zfs_block_dev_desc->dev,
412045704   Rob Herring   cmd_zfs: use comm...
93
94
  		part_info->start + sector, block_len / SECTOR_SIZE,
  		(unsigned long *) buf) != block_len / SECTOR_SIZE) {
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
95
96
97
98
99
100
101
102
103
104
105
106
107
108
  		printf(" ** zfs_devread() read error - block
  ");
  		return 1;
  	}
  
  	block_len = byte_len & ~(SECTOR_SIZE - 1);
  	buf += block_len;
  	byte_len -= block_len;
  	sector += block_len / SECTOR_SIZE;
  
  	if (byte_len != 0) {
  		/* read rest of data which are not in whole sector */
  		if (zfs_block_dev_desc->
  			block_read(zfs_block_dev_desc->dev,
412045704   Rob Herring   cmd_zfs: use comm...
109
  					   part_info->start + sector, 1,
4d3c95f5e   Jorgen Lundman   zfs: Add ZFS file...
110
111
112
113
114
115
116
117
118
  					   (unsigned long *) sec_buf) != 1) {
  			printf(" ** zfs_devread() read error - last part
  ");
  			return 1;
  		}
  		memcpy(buf, sec_buf, byte_len);
  	}
  	return 0;
  }