diff options
Diffstat (limited to 'lib/libefi/libefi.c')
-rw-r--r-- | lib/libefi/libefi.c | 176 |
1 files changed, 176 insertions, 0 deletions
diff --git a/lib/libefi/libefi.c b/lib/libefi/libefi.c new file mode 100644 index 0000000..c65784f --- /dev/null +++ b/lib/libefi/libefi.c @@ -0,0 +1,176 @@ +/*- + * Copyright (c) 2010 Marcel Moolenaar + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include <sys/cdefs.h> +__FBSDID("$FreeBSD$"); + +#include <sys/ioctl.h> +#include <sys/types.h> +#include <fcntl.h> +#include <stddef.h> +#include <stdlib.h> +#include <string.h> +#include <unistd.h> + +#include "libefi_int.h" + +static int __iofd = -1; + +static void +iodev_fd_close(void) +{ + + close(__iofd); +} + +static int +iodev_fd(int *fd) +{ + + *fd = __iofd; + if (__iofd != -1) + return (0); + + __iofd = open("/dev/io", O_RDWR); + if (__iofd == -1) + return (errno); + + atexit(iodev_fd_close); + *fd = __iofd; + return (0); +} + +int +libefi_ucs2_to_utf8(u_short *nm, size_t *szp, char *name) +{ + size_t len, sz; + u_short c; + + len = 0; + sz = *szp; + while (*nm) { + c = *nm++; + if (c > 0x7ff) { + if (len++ < sz) + *name++ = 0xE0 | (c >> 12); + if (len++ < sz) + *name++ = 0x80 | ((c >> 6) & 0x3f); + if (len++ < sz) + *name++ = 0x80 | (c & 0x3f); + } else if (c > 0x7f) { + if (len++ < sz) + *name++ = 0xC0 | ((c >> 6) & 0x1f); + if (len++ < sz) + *name++ = 0x80 | (c & 0x3f); + } else { + if (len++ < sz) + *name++ = (c & 0x7f); + } + } + if (len++ < sz) + *name++ = 0; + + *szp = len; + return ((len <= sz) ? 0 : EOVERFLOW); +} + +int +libefi_utf8_to_ucs2(char *name, size_t *szp, u_short **nmp) +{ + u_short *nm; + size_t sz; + uint32_t ucs4; + int c, bytes; + + *szp = sz = (*szp == 0) ? strlen(name) * 2 + 2 : *szp; + *nmp = nm = malloc(sz); + + ucs4 = 0; + bytes = 0; + while (sz > 1 && *name != '\0') { + c = *name++; + /* + * Conditionalize on the two major character types: + * initial and followup characters. + */ + if ((c & 0xc0) != 0x80) { + /* Initial characters. */ + if (bytes != 0) { + free(nm); + return (EILSEQ); + } + if ((c & 0xf8) == 0xf0) { + ucs4 = c & 0x07; + bytes = 3; + } else if ((c & 0xf0) == 0xe0) { + ucs4 = c & 0x0f; + bytes = 2; + } else if ((c & 0xe0) == 0xc0) { + ucs4 = c & 0x1f; + bytes = 1; + } else { + ucs4 = c & 0x7f; + bytes = 0; + } + } else { + /* Followup characters. */ + if (bytes > 0) { + ucs4 = (ucs4 << 6) + (c & 0x3f); + bytes--; + } else if (bytes == 0) { + free(nm); + return (EILSEQ); + } + } + if (bytes == 0) { + if (ucs4 > 0xffff) { + free(nm); + return (EILSEQ); + } + *nm++ = (u_short)ucs4; + sz -= 2; + } + } + if (sz < 2) { + free(nm); + return (EDOOFUS); + } + *nm = 0; + return (0); +} + +int +libefi_efivar(struct iodev_efivar_req *req) +{ + int error, fd; + + error = iodev_fd(&fd); + if (!error) + error = (ioctl(fd, IODEV_EFIVAR, req) == -1) ? errno : 0; + if (!error) + error = req->result; + return (error); +} |