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
41static dev_info_t *devices;
42
43uint64_t
44ldi_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
52static int
53vdev_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
104error:
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
113static EFI_STATUS
114probe(dev_info_t *dev)
115{
116	spa_t *spa;
117	dev_info_t *tdev;
118
119	/* ZFS consumes the dev on success so we need a copy. */
120	tdev = malloc(sizeof(*dev));
121	if (tdev == NULL) {
122		DPRINTF("Failed to allocate tdev\n");
123		return (EFI_OUT_OF_RESOURCES);
124	}
125	memcpy(tdev, dev, sizeof(*dev));
126
127	if (vdev_probe(vdev_read, tdev, &spa) != 0) {
128		free(tdev);
129		return (EFI_UNSUPPORTED);
130	}
131
132	dev->devdata = spa;
133	add_device(&devices, dev);
134
135	return (EFI_SUCCESS);
136}
137
138static EFI_STATUS
139load(const char *filepath, dev_info_t *devinfo, void **bufp, size_t *bufsize)
140{
141	spa_t *spa;
142	struct zfsmount zmount;
143	dnode_phys_t dn;
144	struct stat st;
145	int err;
146	void *buf;
147
148	spa = devinfo->devdata;
149
150#ifdef EFI_DEBUG
151	{
152		CHAR16 *text = efi_devpath_name(devinfo->devpath);
153		DPRINTF("load: '%s' spa: '%s', devpath: %S\n", filepath,
154		    spa->spa_name, text);
155		efi_free_devpath_name(text);
156	}
157#endif
158	if ((err = zfs_spa_init(spa)) != 0) {
159		DPRINTF("Failed to load pool '%s' (%d)\n", spa->spa_name, err);
160		return (EFI_NOT_FOUND);
161	}
162
163	if ((err = zfs_mount(spa, 0, &zmount)) != 0) {
164		DPRINTF("Failed to mount pool '%s' (%d)\n", spa->spa_name, err);
165		return (EFI_NOT_FOUND);
166	}
167
168	if ((err = zfs_lookup(&zmount, filepath, &dn)) != 0) {
169		if (err == ENOENT) {
170			DPRINTF("Failed to find '%s' on pool '%s' (%d)\n",
171			    filepath, spa->spa_name, err);
172			return (EFI_NOT_FOUND);
173		}
174		printf("Failed to lookup '%s' on pool '%s' (%d)\n", filepath,
175		    spa->spa_name, err);
176		return (EFI_INVALID_PARAMETER);
177	}
178
179	if ((err = zfs_dnode_stat(spa, &dn, &st)) != 0) {
180		printf("Failed to stat '%s' on pool '%s' (%d)\n", filepath,
181		    spa->spa_name, err);
182		return (EFI_INVALID_PARAMETER);
183	}
184
185	buf = malloc(st.st_size);
186	if (buf == NULL) {
187		printf("Failed to allocate load buffer %jd for pool '%s' for '%s' ",
188		    (intmax_t)st.st_size, spa->spa_name, filepath);
189		return (EFI_INVALID_PARAMETER);
190	}
191
192	if ((err = dnode_read(spa, &dn, 0, buf, st.st_size)) != 0) {
193		printf("Failed to read node from %s (%d)\n", spa->spa_name,
194		    err);
195		free(buf);
196		return (EFI_INVALID_PARAMETER);
197	}
198
199	*bufsize = st.st_size;
200	*bufp = buf;
201
202	return (EFI_SUCCESS);
203}
204
205static void
206status(void)
207{
208	spa_t *spa;
209
210	spa = STAILQ_FIRST(&zfs_pools);
211	if (spa == NULL) {
212		printf("%s found no pools\n", zfs_module.name);
213		return;
214	}
215
216	printf("%s found the following pools:", zfs_module.name);
217	STAILQ_FOREACH(spa, &zfs_pools, spa_link)
218		printf(" %s", spa->spa_name);
219
220	printf("\n");
221}
222
223static void
224init(void)
225{
226
227	zfs_init();
228}
229
230static dev_info_t *
231_devices(void)
232{
233
234	return (devices);
235}
236
237const boot_module_t zfs_module =
238{
239	.name = "ZFS",
240	.init = init,
241	.probe = probe,
242	.load = load,
243	.status = status,
244	.devices = _devices
245};
246