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#include <common.h>
32#include <blk.h>
33#include <dm.h>
34#include <efi_driver.h>
35#include <malloc.h>
36#include <dm/device-internal.h>
37#include <dm/root.h>
38
39
40
41
42
43
44
45struct efi_blk_plat {
46 efi_handle_t handle;
47 struct efi_block_io *io;
48};
49
50
51
52
53
54
55
56
57
58
59static ulong efi_bl_read(struct udevice *dev, lbaint_t blknr, lbaint_t blkcnt,
60 void *buffer)
61{
62 struct efi_blk_plat *plat = dev_get_plat(dev);
63 struct efi_block_io *io = plat->io;
64 efi_status_t ret;
65
66 EFI_PRINT("%s: read '%s', from block " LBAFU ", " LBAFU " blocks\n",
67 __func__, dev->name, blknr, blkcnt);
68 ret = EFI_CALL(io->read_blocks(
69 io, io->media->media_id, (u64)blknr,
70 (efi_uintn_t)blkcnt *
71 (efi_uintn_t)io->media->block_size, buffer));
72 EFI_PRINT("%s: r = %u\n", __func__,
73 (unsigned int)(ret & ~EFI_ERROR_MASK));
74 if (ret != EFI_SUCCESS)
75 return 0;
76 return blkcnt;
77}
78
79
80
81
82
83
84
85
86
87
88static ulong efi_bl_write(struct udevice *dev, lbaint_t blknr, lbaint_t blkcnt,
89 const void *buffer)
90{
91 struct efi_blk_plat *plat = dev_get_plat(dev);
92 struct efi_block_io *io = plat->io;
93 efi_status_t ret;
94
95 EFI_PRINT("%s: write '%s', from block " LBAFU ", " LBAFU " blocks\n",
96 __func__, dev->name, blknr, blkcnt);
97 ret = EFI_CALL(io->write_blocks(
98 io, io->media->media_id, (u64)blknr,
99 (efi_uintn_t)blkcnt *
100 (efi_uintn_t)io->media->block_size,
101 (void *)buffer));
102 EFI_PRINT("%s: r = %u\n", __func__,
103 (unsigned int)(ret & ~EFI_ERROR_MASK));
104 if (ret != EFI_SUCCESS)
105 return 0;
106 return blkcnt;
107}
108
109
110
111
112
113
114
115
116static int efi_bl_bind_partitions(efi_handle_t handle, struct udevice *dev)
117{
118 struct blk_desc *desc;
119 const char *if_typename;
120
121 desc = dev_get_uclass_plat(dev);
122 if_typename = blk_get_if_type_name(desc->if_type);
123
124 return efi_disk_create_partitions(handle, desc, if_typename,
125 desc->devnum, dev->name);
126}
127
128
129
130
131
132
133
134
135static int efi_bl_bind(efi_handle_t handle, void *interface)
136{
137 struct udevice *bdev, *parent = dm_root();
138 int ret, devnum;
139 char *name;
140 struct efi_object *obj = efi_search_obj(handle);
141 struct efi_block_io *io = interface;
142 int disks;
143 struct efi_blk_plat *plat;
144
145 EFI_PRINT("%s: handle %p, interface %p\n", __func__, handle, io);
146
147 if (!obj)
148 return -ENOENT;
149
150 devnum = blk_find_max_devnum(IF_TYPE_EFI);
151 if (devnum == -ENODEV)
152 devnum = 0;
153 else if (devnum < 0)
154 return devnum;
155
156 name = calloc(1, 18);
157 if (!name)
158 return -ENOMEM;
159 sprintf(name, "efiblk#%d", devnum);
160
161
162 ret = blk_create_device(parent, "efi_blk", name, IF_TYPE_EFI, devnum,
163 io->media->block_size,
164 (lbaint_t)io->media->last_block, &bdev);
165 if (ret)
166 return ret;
167 if (!bdev)
168 return -ENOENT;
169
170 device_set_name_alloced(bdev);
171
172 plat = dev_get_plat(bdev);
173 plat->handle = handle;
174 plat->io = interface;
175
176 ret = device_probe(bdev);
177 if (ret)
178 return ret;
179 EFI_PRINT("%s: block device '%s' created\n", __func__, bdev->name);
180
181
182 disks = efi_bl_bind_partitions(handle, bdev);
183 EFI_PRINT("Found %d partitions\n", disks);
184
185 return 0;
186}
187
188
189static const struct blk_ops efi_blk_ops = {
190 .read = efi_bl_read,
191 .write = efi_bl_write,
192};
193
194
195U_BOOT_DRIVER(efi_blk) = {
196 .name = "efi_blk",
197 .id = UCLASS_BLK,
198 .ops = &efi_blk_ops,
199 .plat_auto = sizeof(struct efi_blk_plat),
200};
201
202
203static const struct efi_driver_ops driver_ops = {
204 .protocol = &efi_block_io_guid,
205 .child_protocol = &efi_block_io_guid,
206 .bind = efi_bl_bind,
207};
208
209
210U_BOOT_DRIVER(efi_block) = {
211 .name = "EFI block driver",
212 .id = UCLASS_EFI,
213 .ops = &driver_ops,
214};
215