usr/src/cmd/fm/modules/sun4v/generic-mem/gmem_util.c

   1 /*
   2  * CDDL HEADER START
   3  *
   4  * The contents of this file are subject to the terms of the
   5  * Common Development and Distribution License (the "License").
   6  * You may not use this file except in compliance with the License.
   7  *
   8  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
   9  * or http://www.opensolaris.org/os/licensing.
  10  * See the License for the specific language governing permissions
  11  * and limitations under the License.
  12  *
  13  * When distributing Covered Code, include this CDDL HEADER in each
  14  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
  15  * If applicable, add the following below this CDDL HEADER, with the
  16  * fields enclosed by brackets "[]" replaced with your own identifying
  17  * information: Portions Copyright [yyyy] [name of copyright owner]
  18  *
  19  * CDDL HEADER END
  20  */
  21 /*
  22  * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
  23  * Use is subject to license terms.
  24  */
  25
  26 #include <gmem.h>
  27 #include <gmem_util.h>
  28
  29 #include <errno.h>
  30 #include <stdarg.h>
  31 #include <string.h>
  32 #include <fm/fmd_api.h>
  33 #include <sys/fm/protocol.h>
  34
  35 int
  36 gmem_set_errno(int err)
  37 {
  38         errno = err;
  39         return (-1);
  40 }
  41
  42 void *
  43 gmem_buf_read(fmd_hdl_t *hdl, fmd_case_t *cp, const char *bufname, size_t bufsz)
  44 {
  45         void *buf;
  46         size_t sz;
  47
  48         if ((sz = fmd_buf_size(hdl, cp, bufname)) == 0) {
  49                 (void) gmem_set_errno(ENOENT);
  50                 return (NULL);
  51         } else if (sz != bufsz) {
  52                 (void) gmem_set_errno(EINVAL);
  53                 return (NULL);
  54         }
  55
  56         buf = fmd_hdl_alloc(hdl, bufsz, FMD_SLEEP);
  57         fmd_buf_read(hdl, cp, bufname, buf, bufsz);
  58
  59         return (buf);
  60 }
  61
  62 void
  63 gmem_vbufname(char *buf, size_t bufsz, const char *fmt, va_list ap)
  64 {
  65         char *c;
  66
  67         (void) vsnprintf(buf, bufsz, fmt, ap);
  68
  69         for (c = buf; *c != '\0'; c++) {
  70                 if (*c == ' ' || *c == '/' || *c == ':')
  71                         *c = '_';
  72         }
  73 }
  74
  75 void
  76 gmem_bufname(char *buf, size_t bufsz, const char *fmt, ...)
  77 {
  78         va_list ap;
  79
  80         va_start(ap, fmt);
  81         gmem_vbufname(buf, bufsz, fmt, ap);
  82         va_end(ap);
  83 }
  84
  85 void
  86 gmem_list_append(gmem_list_t *lp, void *new)
  87 {
  88         gmem_list_t *p = lp->l_prev;    /* p = tail list element */
  89         gmem_list_t *q = new;           /* q = new list element */
  90
  91         lp->l_prev = q;
  92         q->l_prev = p;
  93         q->l_next = NULL;
  94
  95         if (p != NULL)
  96                 p->l_next = q;
  97         else
  98                 lp->l_next = q;
  99 }
 100
 101 void
 102 gmem_list_prepend(gmem_list_t *lp, void *new)
 103 {
 104         gmem_list_t *p = new;           /* p = new list element */
 105         gmem_list_t *q = lp->l_next;    /* q = head list element */
 106
 107         lp->l_next = p;
 108         p->l_prev = NULL;
 109         p->l_next = q;
 110
 111         if (q != NULL)
 112                 q->l_prev = p;
 113         else
 114                 lp->l_prev = p;
 115 }
 116
 117 void
 118 gmem_list_insert_before(gmem_list_t *lp, void *before_me, void *new)
 119 {
 120         gmem_list_t *p = before_me;
 121         gmem_list_t *q = new;
 122
 123         if (p == NULL || p->l_prev == NULL) {
 124                 gmem_list_prepend(lp, new);
 125                 return;
 126         }
 127
 128         q->l_prev = p->l_prev;
 129         q->l_next = p;
 130         p->l_prev = q;
 131         q->l_prev->l_next = q;
 132 }
 133
 134 void
 135 gmem_list_insert_after(gmem_list_t *lp, void *after_me, void *new)
 136 {
 137         gmem_list_t *p = after_me;
 138         gmem_list_t *q = new;
 139
 140         if (p == NULL || p->l_next == NULL) {
 141                 gmem_list_append(lp, new);
 142                 return;
 143         }
 144
 145         q->l_next = p->l_next;
 146         q->l_prev = p;
 147         p->l_next = q;
 148         q->l_next->l_prev = q;
 149 }
 150
 151 void
 152 gmem_list_delete(gmem_list_t *lp, void *existing)
 153 {
 154         gmem_list_t *p = existing;
 155
 156         if (p->l_prev != NULL)
 157                 p->l_prev->l_next = p->l_next;
 158         else
 159                 lp->l_next = p->l_next;
 160
 161         if (p->l_next != NULL)
 162                 p->l_next->l_prev = p->l_prev;
 163         else
 164                 lp->l_prev = p->l_prev;
 165 }