sun4v/generic-mem/gmem_util.c

1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport/*
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * CDDL HEADER START
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport *
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * The contents of this file are subject to the terms of the
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * Common Development and Distribution License (the "License").
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * You may not use this file except in compliance with the License.
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport *
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * or http://www.opensolaris.org/os/licensing.
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * See the License for the specific language governing permissions
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * and limitations under the License.
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport *
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * When distributing Covered Code, include this CDDL HEADER in each
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * If applicable, add the following below this CDDL HEADER, with the
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * fields enclosed by brackets "[]" replaced with your own identifying
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * information: Portions Copyright [yyyy] [name of copyright owner]
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport *
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * CDDL HEADER END
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport */
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport/*
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport * Use is subject to license terms.
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport */
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport#include <gmem.h>
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport#include <gmem_util.h>
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport#include <errno.h>
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport#include <stdarg.h>
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport#include <string.h>
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport#include <fm/fmd_api.h>
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport#include <sys/fm/protocol.h>
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportint
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportgmem_set_errno(int err)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport{
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    errno = err;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    return (-1);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport}
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportvoid *
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportgmem_buf_read(fmd_hdl_t *hdl, fmd_case_t *cp, const char *bufname, size_t bufsz)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport{
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    void *buf;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    size_t sz;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    if ((sz = fmd_buf_size(hdl, cp, bufname)) == 0) {
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        (void) gmem_set_errno(ENOENT);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        return (NULL);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    } else if (sz != bufsz) {
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        (void) gmem_set_errno(EINVAL);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        return (NULL);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    }
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    buf = fmd_hdl_alloc(hdl, bufsz, FMD_SLEEP);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    fmd_buf_read(hdl, cp, bufname, buf, bufsz);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    return (buf);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport}
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportvoid
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportgmem_vbufname(char *buf, size_t bufsz, const char *fmt, va_list ap)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport{
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    char *c;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    (void) vsnprintf(buf, bufsz, fmt, ap);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    for (c = buf; *c != '\0'; c++) {
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        if (*c == ' ' || *c == '/' || *c == ':')
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport            *c = '_';
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    }
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport}
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportvoid
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportgmem_bufname(char *buf, size_t bufsz, const char *fmt, ...)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport{
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    va_list ap;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    va_start(ap, fmt);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_vbufname(buf, bufsz, fmt, ap);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    va_end(ap);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport}
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportvoid
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportgmem_list_append(gmem_list_t *lp, void *new)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport{
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_list_t *p = lp->l_prev;    /* p = tail list element */
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_list_t *q = new;       /* q = new list element */
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    lp->l_prev = q;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    q->l_prev = p;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    q->l_next = NULL;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    if (p != NULL)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        p->l_next = q;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    else
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        lp->l_next = q;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport}
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportvoid
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportgmem_list_prepend(gmem_list_t *lp, void *new)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport{
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_list_t *p = new;       /* p = new list element */
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_list_t *q = lp->l_next;    /* q = head list element */
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    lp->l_next = p;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    p->l_prev = NULL;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    p->l_next = q;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    if (q != NULL)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        q->l_prev = p;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    else
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        lp->l_prev = p;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport}
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportvoid
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportgmem_list_insert_before(gmem_list_t *lp, void *before_me, void *new)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport{
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_list_t *p = before_me;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_list_t *q = new;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    if (p == NULL || p->l_prev == NULL) {
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        gmem_list_prepend(lp, new);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        return;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    }
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    q->l_prev = p->l_prev;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    q->l_next = p;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    p->l_prev = q;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    q->l_prev->l_next = q;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport}
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportvoid
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportgmem_list_insert_after(gmem_list_t *lp, void *after_me, void *new)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport{
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_list_t *p = after_me;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_list_t *q = new;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    if (p == NULL || p->l_next == NULL) {
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        gmem_list_append(lp, new);
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        return;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    }
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    q->l_next = p->l_next;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    q->l_prev = p;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    p->l_next = q;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    q->l_next->l_prev = q;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport}
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportvoid
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenportgmem_list_delete(gmem_list_t *lp, void *existing)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport{
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    gmem_list_t *p = existing;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    if (p->l_prev != NULL)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        p->l_prev->l_next = p->l_next;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    else
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        lp->l_next = p->l_next;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    if (p->l_next != NULL)
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        p->l_next->l_prev = p->l_prev;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport    else
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport        lp->l_prev = p->l_prev;
1529f529004c61fcfd0d95ab79b0f257d6ad4451Scott Davenport}