stand/efi/boot1/zfs_module.c

   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
  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
  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
 114 probe(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
 138 static EFI_STATUS
 139 load(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
 205 static void
 206 status(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
 223 static void
 224 init(void)
 225 {
 226
 227         zfs_init();
 228 }
 229
 230 static dev_info_t *
 231 _devices(void)
 232 {
 233
 234         return (devices);
 235 }
 236
 237 const 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 };