1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
|
// SPDX-License-Identifier: GPL-2.0+
/*
* (C) Copyright 2024 SaluteDevices, Inc.
*
* Author: Alexey Romanov <avromanov@salutedevices.com>
*/
#include <blk.h>
#include <part.h>
#include <ubi_uboot.h>
#include <dm/device.h>
#include <dm/device-internal.h>
int ubi_bind(struct udevice *dev)
{
struct blk_desc *bdesc;
struct udevice *bdev;
int ret;
ret = blk_create_devicef(dev, "ubi_blk", "blk", UCLASS_MTD,
-1, 512, 0, &bdev);
if (ret) {
pr_err("Cannot create block device");
return ret;
}
bdesc = dev_get_uclass_plat(bdev);
bdesc->bdev = bdev;
bdesc->part_type = PART_TYPE_UBI;
return 0;
}
static struct ubi_device *get_ubi_device(void)
{
return ubi_devices[0];
}
static char *get_volume_name(int vol_id)
{
struct ubi_device *ubi = get_ubi_device();
int i;
for (i = 0; i < (ubi->vtbl_slots + 1); i++) {
struct ubi_volume *volume = ubi->volumes[i];
if (!volume)
continue;
if (volume->vol_id >= UBI_INTERNAL_VOL_START)
continue;
if (volume->vol_id == vol_id)
return volume->name;
}
return NULL;
}
static ulong ubi_bread(struct udevice *dev, lbaint_t start, lbaint_t blkcnt,
void *dst)
{
struct blk_desc *block_dev = dev_get_uclass_plat(dev);
char *volume_name = get_volume_name(block_dev->hwpart);
unsigned int size = blkcnt * block_dev->blksz;
loff_t offset = start * block_dev->blksz;
int ret;
if (!volume_name) {
pr_err("%s: failed to find volume name for blk=" LBAF "\n", __func__, start);
return -EINVAL;
}
ret = ubi_volume_read(volume_name, dst, offset, size);
if (ret) {
pr_err("%s: failed to read from %s UBI volume\n", __func__, volume_name);
return ret;
}
return blkcnt;
}
static ulong ubi_bwrite(struct udevice *dev, lbaint_t start, lbaint_t blkcnt,
const void *src)
{
struct blk_desc *block_dev = dev_get_uclass_plat(dev);
char *volume_name = get_volume_name(block_dev->hwpart);
unsigned int size = blkcnt * block_dev->blksz;
loff_t offset = start * block_dev->blksz;
int ret;
if (!volume_name) {
pr_err("%s: failed to find volume for blk=" LBAF "\n", __func__, start);
return -EINVAL;
}
ret = ubi_volume_write(volume_name, (void *)src, offset, size);
if (ret) {
pr_err("%s: failed to write from %s UBI volume\n", __func__, volume_name);
return ret;
}
return blkcnt;
}
static int ubi_blk_probe(struct udevice *dev)
{
int ret;
ret = device_probe(dev);
if (ret) {
pr_err("Probing %s failed (err=%d)\n", dev->name, ret);
return ret;
}
return 0;
}
static const struct blk_ops ubi_blk_ops = {
.read = ubi_bread,
.write = ubi_bwrite,
};
U_BOOT_DRIVER(ubi_blk) = {
.name = "ubi_blk",
.id = UCLASS_BLK,
.ops = &ubi_blk_ops,
.probe = ubi_blk_probe,
};
|
