Current Path : /usr/src/lib/libefi/ |
FreeBSD hs32.drive.ne.jp 9.1-RELEASE FreeBSD 9.1-RELEASE #1: Wed Jan 14 12:18:08 JST 2015 root@hs32.drive.ne.jp:/sys/amd64/compile/hs32 amd64 |
Current File : //usr/src/lib/libefi/libefi.c |
/*- * 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: release/9.1.0/lib/libefi/libefi.c 203181 2010-01-30 04:24:03Z marcel $"); #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); }