dev.c (7c4213f6a52f35ff6ba2d97aa4eb04cbfc963b86) dev.c (4101f6879256720b30df712089a3df18565f9203)
1/*
2 *
3 * based on code of fs/reiserfs/dev.c by
4 *
5 * (C) Copyright 2003 - 2004
6 * Sysgo AG, <www.elinos.com>, Pavel Bartusek <pba@sysgo.com>
7 *
8 * SPDX-License-Identifier: GPL-2.0+
9 */
10
11
12#include <common.h>
13#include <config.h>
14#include <zfs_common.h>
15
1/*
2 *
3 * based on code of fs/reiserfs/dev.c by
4 *
5 * (C) Copyright 2003 - 2004
6 * Sysgo AG, <www.elinos.com>, Pavel Bartusek <pba@sysgo.com>
7 *
8 * SPDX-License-Identifier: GPL-2.0+
9 */
10
11
12#include <common.h>
13#include <config.h>
14#include <zfs_common.h>
15
16static block_dev_desc_t *zfs_block_dev_desc;
16static struct blk_desc *zfs_blk_desc;
17static disk_partition_t *part_info;
18
17static disk_partition_t *part_info;
18
19void zfs_set_blk_dev(block_dev_desc_t *rbdd, disk_partition_t *info)
19void zfs_set_blk_dev(struct blk_desc *rbdd, disk_partition_t *info)
20{
20{
21 zfs_block_dev_desc = rbdd;
21 zfs_blk_desc = rbdd;
22 part_info = info;
23}
24
25/* err */
26int zfs_devread(int sector, int byte_offset, int byte_len, char *buf)
27{
28 short sec_buffer[SECTOR_SIZE/sizeof(short)];
29 char *sec_buf = (char *)sec_buffer;

--- 13 unchanged lines hidden (view full) ---

43 /*
44 * Get the read to the beginning of a partition.
45 */
46 sector += byte_offset >> SECTOR_BITS;
47 byte_offset &= SECTOR_SIZE - 1;
48
49 debug(" <%d, %d, %d>\n", sector, byte_offset, byte_len);
50
22 part_info = info;
23}
24
25/* err */
26int zfs_devread(int sector, int byte_offset, int byte_len, char *buf)
27{
28 short sec_buffer[SECTOR_SIZE/sizeof(short)];
29 char *sec_buf = (char *)sec_buffer;

--- 13 unchanged lines hidden (view full) ---

43 /*
44 * Get the read to the beginning of a partition.
45 */
46 sector += byte_offset >> SECTOR_BITS;
47 byte_offset &= SECTOR_SIZE - 1;
48
49 debug(" <%d, %d, %d>\n", sector, byte_offset, byte_len);
50
51 if (zfs_block_dev_desc == NULL) {
51 if (zfs_blk_desc == NULL) {
52 printf("** Invalid Block Device Descriptor (NULL)\n");
53 return 1;
54 }
55
56 if (byte_offset != 0) {
57 /* read first part which isn't aligned with start of sector */
52 printf("** Invalid Block Device Descriptor (NULL)\n");
53 return 1;
54 }
55
56 if (byte_offset != 0) {
57 /* read first part which isn't aligned with start of sector */
58 if (zfs_block_dev_desc->block_read(zfs_block_dev_desc,
59 part_info->start + sector, 1,
60 (void *)sec_buf)
61 != 1) {
58 if (zfs_blk_desc->block_read(zfs_blk_desc,
59 part_info->start + sector, 1,
60 (void *)sec_buf) != 1) {
62 printf(" ** zfs_devread() read error **\n");
63 return 1;
64 }
65 memcpy(buf, sec_buf + byte_offset,
66 min(SECTOR_SIZE - byte_offset, byte_len));
67 buf += min(SECTOR_SIZE - byte_offset, byte_len);
68 byte_len -= min(SECTOR_SIZE - byte_offset, byte_len);
69 sector++;

--- 4 unchanged lines hidden (view full) ---

74
75 /* read sector aligned part */
76 block_len = byte_len & ~(SECTOR_SIZE - 1);
77
78 if (block_len == 0) {
79 u8 p[SECTOR_SIZE];
80
81 block_len = SECTOR_SIZE;
61 printf(" ** zfs_devread() read error **\n");
62 return 1;
63 }
64 memcpy(buf, sec_buf + byte_offset,
65 min(SECTOR_SIZE - byte_offset, byte_len));
66 buf += min(SECTOR_SIZE - byte_offset, byte_len);
67 byte_len -= min(SECTOR_SIZE - byte_offset, byte_len);
68 sector++;

--- 4 unchanged lines hidden (view full) ---

73
74 /* read sector aligned part */
75 block_len = byte_len & ~(SECTOR_SIZE - 1);
76
77 if (block_len == 0) {
78 u8 p[SECTOR_SIZE];
79
80 block_len = SECTOR_SIZE;
82 zfs_block_dev_desc->block_read(zfs_block_dev_desc,
83 part_info->start + sector,
84 1, (void *)p);
81 zfs_blk_desc->block_read(zfs_blk_desc,
82 part_info->start + sector,
83 1, (void *)p);
85 memcpy(buf, p, byte_len);
86 return 0;
87 }
88
84 memcpy(buf, p, byte_len);
85 return 0;
86 }
87
89 if (zfs_block_dev_desc->block_read(zfs_block_dev_desc,
90 part_info->start + sector,
91 block_len / SECTOR_SIZE,
92 (void *)buf)
93 != block_len / SECTOR_SIZE) {
88 if (zfs_blk_desc->block_read(zfs_blk_desc, part_info->start + sector,
89 block_len / SECTOR_SIZE,
90 (void *)buf) != block_len / SECTOR_SIZE) {
94 printf(" ** zfs_devread() read error - block\n");
95 return 1;
96 }
97
98 block_len = byte_len & ~(SECTOR_SIZE - 1);
99 buf += block_len;
100 byte_len -= block_len;
101 sector += block_len / SECTOR_SIZE;
102
103 if (byte_len != 0) {
104 /* read rest of data which are not in whole sector */
91 printf(" ** zfs_devread() read error - block\n");
92 return 1;
93 }
94
95 block_len = byte_len & ~(SECTOR_SIZE - 1);
96 buf += block_len;
97 byte_len -= block_len;
98 sector += block_len / SECTOR_SIZE;
99
100 if (byte_len != 0) {
101 /* read rest of data which are not in whole sector */
105 if (zfs_block_dev_desc->block_read(zfs_block_dev_desc,
106 part_info->start + sector,
107 1, (void *)sec_buf) != 1) {
102 if (zfs_blk_desc->block_read(zfs_blk_desc,
103 part_info->start + sector,
104 1, (void *)sec_buf) != 1) {
108 printf(" ** zfs_devread() read error - last part\n");
109 return 1;
110 }
111 memcpy(buf, sec_buf, byte_len);
112 }
113 return 0;
114}
105 printf(" ** zfs_devread() read error - last part\n");
106 return 1;
107 }
108 memcpy(buf, sec_buf, byte_len);
109 }
110 return 0;
111}