1 /*-
2 * Copyright (c) 2015 Eric McCorkle
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 *
26 * $FreeBSD$
27 */
28 #include <stddef.h>
29 #include <stdarg.h>
30 #include <stdbool.h>
31 #include <sys/cdefs.h>
32 #include <sys/param.h>
33 #include <sys/queue.h>
34 #include <efi.h>
35
36 #include "boot_module.h"
37
38 #include "libzfs.h"
39 #include "zfsimpl.c"
40
41 static dev_info_t *devices;
42
43 uint64_t
ldi_get_size(void * priv)44 ldi_get_size(void *priv)
45 {
46 dev_info_t *devinfo = priv;
47
48 return (devinfo->dev->Media->BlockSize *
49 (devinfo->dev->Media->LastBlock + 1));
50 }
51
52 static int
vdev_read(vdev_t * vdev,void * priv,off_t off,void * buf,size_t bytes)53 vdev_read(vdev_t *vdev, void *priv, off_t off, void *buf, size_t bytes)
54 {
55 dev_info_t *devinfo;
56 uint64_t lba;
57 size_t size, remainder, rb_size, blksz;
58 char *bouncebuf = NULL, *rb_buf;
59 EFI_STATUS status;
60
61 devinfo = (dev_info_t *)priv;
62 lba = off / devinfo->dev->Media->BlockSize;
63 remainder = off % devinfo->dev->Media->BlockSize;
64
65 rb_buf = buf;
66 rb_size = bytes;
67
68 /*
69 * If we have remainder from off, we need to add remainder part.
70 * Since buffer must be multiple of the BlockSize, round it all up.
71 */
72 size = roundup2(bytes + remainder, devinfo->dev->Media->BlockSize);
73 blksz = size;
74 if (remainder != 0 || size != bytes) {
75 rb_size = devinfo->dev->Media->BlockSize;
76 bouncebuf = malloc(rb_size);
77 if (bouncebuf == NULL) {
78 printf("vdev_read: out of memory\n");
79 return (-1);
80 }
81 rb_buf = bouncebuf;
82 blksz = rb_size - remainder;
83 }
84
85 while (bytes > 0) {
86 status = devinfo->dev->ReadBlocks(devinfo->dev,
87 devinfo->dev->Media->MediaId, lba, rb_size, rb_buf);
88 if (EFI_ERROR(status))
89 goto error;
90 if (bytes < blksz)
91 blksz = bytes;
92 if (bouncebuf != NULL)
93 memcpy(buf, rb_buf + remainder, blksz);
94 buf = (void *)((uintptr_t)buf + blksz);
95 bytes -= blksz;
96 lba++;
97 remainder = 0;
98 blksz = rb_size;
99 }
100
101 free(bouncebuf);
102 return (0);
103
104 error:
105 free(bouncebuf);
106 DPRINTF("vdev_read: failed dev: %p, id: %u, lba: %ju, size: %zu,"
107 " rb_size: %zu, status: %lu\n", devinfo->dev,
108 devinfo->dev->Media->MediaId, (uintmax_t)lba, bytes, rb_size,
109 EFI_ERROR_CODE(status));
110 return (-1);
111 }
112
113 static EFI_STATUS
probe(dev_info_t * dev)114 probe(dev_info_t *dev)
115 {
116 spa_t *spa;
117 dev_info_t *tdev;
118 EFI_STATUS status;
119
120 /* ZFS consumes the dev on success so we need a copy. */
121 if ((status = BS->AllocatePool(EfiLoaderData, sizeof(*dev),
122 (void**)&tdev)) != EFI_SUCCESS) {
123 DPRINTF("Failed to allocate tdev (%lu)\n",
124 EFI_ERROR_CODE(status));
125 return (status);
126 }
127 memcpy(tdev, dev, sizeof(*dev));
128
129 if (vdev_probe(vdev_read, tdev, &spa) != 0) {
130 (void)BS->FreePool(tdev);
131 return (EFI_UNSUPPORTED);
132 }
133
134 dev->devdata = spa;
135 add_device(&devices, dev);
136
137 return (EFI_SUCCESS);
138 }
139
140 static EFI_STATUS
load(const char * filepath,dev_info_t * devinfo,void ** bufp,size_t * bufsize)141 load(const char *filepath, dev_info_t *devinfo, void **bufp, size_t *bufsize)
142 {
143 spa_t *spa;
144 struct zfsmount zfsmount;
145 dnode_phys_t dn;
146 struct stat st;
147 int err;
148 void *buf;
149 EFI_STATUS status;
150
151 spa = devinfo->devdata;
152
153 #ifdef EFI_DEBUG
154 {
155 CHAR16 *text = efi_devpath_name(devinfo->devpath);
156 DPRINTF("load: '%s' spa: '%s', devpath: %S\n", filepath,
157 spa->spa_name, text);
158 efi_free_devpath_name(text);
159 }
160 #endif
161 if ((err = zfs_spa_init(spa)) != 0) {
162 DPRINTF("Failed to load pool '%s' (%d)\n", spa->spa_name, err);
163 return (EFI_NOT_FOUND);
164 }
165
166 if ((err = zfs_mount(spa, 0, &zfsmount)) != 0) {
167 DPRINTF("Failed to mount pool '%s' (%d)\n", spa->spa_name, err);
168 return (EFI_NOT_FOUND);
169 }
170
171 if ((err = zfs_lookup(&zfsmount, filepath, &dn)) != 0) {
172 if (err == ENOENT) {
173 DPRINTF("Failed to find '%s' on pool '%s' (%d)\n",
174 filepath, spa->spa_name, err);
175 return (EFI_NOT_FOUND);
176 }
177 printf("Failed to lookup '%s' on pool '%s' (%d)\n", filepath,
178 spa->spa_name, err);
179 return (EFI_INVALID_PARAMETER);
180 }
181
182 if ((err = zfs_dnode_stat(spa, &dn, &st)) != 0) {
183 printf("Failed to stat '%s' on pool '%s' (%d)\n", filepath,
184 spa->spa_name, err);
185 return (EFI_INVALID_PARAMETER);
186 }
187
188 if ((status = BS->AllocatePool(EfiLoaderData, (UINTN)st.st_size, &buf))
189 != EFI_SUCCESS) {
190 printf("Failed to allocate load buffer %jd for pool '%s' for '%s' "
191 "(%lu)\n", (intmax_t)st.st_size, spa->spa_name, filepath, EFI_ERROR_CODE(status));
192 return (EFI_INVALID_PARAMETER);
193 }
194
195 if ((err = dnode_read(spa, &dn, 0, buf, st.st_size)) != 0) {
196 printf("Failed to read node from %s (%d)\n", spa->spa_name,
197 err);
198 (void)BS->FreePool(buf);
199 return (EFI_INVALID_PARAMETER);
200 }
201
202 *bufsize = st.st_size;
203 *bufp = buf;
204
205 return (EFI_SUCCESS);
206 }
207
208 static void
status(void)209 status(void)
210 {
211 spa_t *spa;
212
213 spa = STAILQ_FIRST(&zfs_pools);
214 if (spa == NULL) {
215 printf("%s found no pools\n", zfs_module.name);
216 return;
217 }
218
219 printf("%s found the following pools:", zfs_module.name);
220 STAILQ_FOREACH(spa, &zfs_pools, spa_link)
221 printf(" %s", spa->spa_name);
222
223 printf("\n");
224 }
225
226 static void
init(void)227 init(void)
228 {
229
230 zfs_init();
231 }
232
233 static dev_info_t *
_devices(void)234 _devices(void)
235 {
236
237 return (devices);
238 }
239
240 const boot_module_t zfs_module =
241 {
242 .name = "ZFS",
243 .init = init,
244 .probe = probe,
245 .load = load,
246 .status = status,
247 .devices = _devices
248 };
249