io/px/px_msiq.c

	px_msiq.c revision 7c478bd95313f5f23a4c958a745db2134aa03244
/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License, Version 1.0 only
 * (the "License").  You may not use this file except in compliance
 * with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*
 * Copyright 2005 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

#pragma ident   "%Z%%M% %I% %E% SMI"

/*
 * px_msiq.c
 */

#include <sys/types.h>
#include <sys/kmem.h>
#include <sys/conf.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/modctl.h>
#include <sys/disp.h>
#include <sys/stat.h>
#include <sys/ddi_impldefs.h>
#include "px_obj.h"

static void px_msiq_get_props(px_t *px_p);

/*
 * px_msiq_attach()
 */
int
px_msiq_attach(px_t *px_p)
{
    px_msiq_state_t *msiq_state_p = &px_p->px_ib_p->ib_msiq_state;
    caddr_t     msiq_addr;
    size_t      msiq_size;
    int     i, ret = DDI_SUCCESS;

    DBG(DBG_MSIQ, px_p->px_dip, "px_msiq_attach\n");

    /*
     * Check for all MSIQ related properties and
     * save all information.
     *
     * Avaialble MSIQs and its properties.
     */
    px_msiq_get_props(px_p);

    /*
     * 10% of available MSIQs are reserved for the PCIe messages.
     * Around 90% of available MSIQs are reserved for the MSI/Xs.
     */
    msiq_state_p->msiq_msg_qcnt = howmany(msiq_state_p->msiq_cnt, 10);
    msiq_state_p->msiq_msi_qcnt = msiq_state_p->msiq_cnt -
        msiq_state_p->msiq_msg_qcnt;

    msiq_state_p->msiq_1st_msi_qid = msiq_state_p->msiq_1st_msiq_id;
    msiq_state_p->msiq_next_msi_qid = msiq_state_p->msiq_1st_msi_qid;

    msiq_state_p->msiq_1st_msg_qid = msiq_state_p->msiq_1st_msiq_id +
        msiq_state_p->msiq_msi_qcnt;
    msiq_state_p->msiq_next_msg_qid = msiq_state_p->msiq_1st_msg_qid;

    mutex_init(&msiq_state_p->msiq_mutex, NULL, MUTEX_DRIVER, NULL);
    msiq_state_p->msiq_p = kmem_zalloc(msiq_state_p->msiq_cnt *
        sizeof (px_msiq_t), KM_SLEEP);

    msiq_size = msiq_state_p->msiq_rec_cnt * sizeof (msiq_rec_t);
    msiq_state_p->msiq_buf_p = kmem_zalloc(msiq_state_p->msiq_cnt *
        msiq_size, KM_SLEEP);

    msiq_addr = (caddr_t)(((uint64_t)msiq_state_p->msiq_buf_p +
        (MMU_PAGE_SIZE - 1)) >> MMU_PAGE_SHIFT << MMU_PAGE_SHIFT);

    for (i = 0; i < msiq_state_p->msiq_cnt; i++) {
        msiq_state_p->msiq_p[i].msiq_id =
            msiq_state_p->msiq_1st_msiq_id + i;
        msiq_state_p->msiq_p[i].msiq_state = MSIQ_STATE_FREE;

        msiq_state_p->msiq_p[i].msiq_base = (uint64_t)
            ((caddr_t)msiq_addr + (i * msiq_size));
        msiq_state_p->msiq_p[i].msiq_curr =
            msiq_state_p->msiq_p[i].msiq_base;
    }

    if ((ret = px_lib_msiq_init(px_p->px_dip)) != DDI_SUCCESS)
        px_msiq_detach(px_p);

    return (ret);
}

/*
 * px_msiq_detach()
 */
void
px_msiq_detach(px_t *px_p)
{
    px_msiq_state_t *msiq_state_p = &px_p->px_ib_p->ib_msiq_state;

    DBG(DBG_MSIQ, px_p->px_dip, "px_msiq_detach\n");

    (void) px_lib_msiq_fini(px_p->px_dip);
    kmem_free(msiq_state_p->msiq_buf_p, msiq_state_p->msiq_cnt *
        msiq_state_p->msiq_rec_cnt * sizeof (msiq_rec_t));

    mutex_destroy(&msiq_state_p->msiq_mutex);
    kmem_free(msiq_state_p->msiq_p,
        msiq_state_p->msiq_cnt * sizeof (px_msiq_t));

    bzero(&px_p->px_ib_p->ib_msiq_state, sizeof (px_msiq_state_t));
}

/*
 * px_msiq_alloc()
 */
int
px_msiq_alloc(px_t *px_p, msiq_rec_type_t rec_type, msiqid_t *msiq_id_p)
{
    px_msiq_state_t *msiq_state_p = &px_p->px_ib_p->ib_msiq_state;
    msiqid_t    first_msiq_id, *next_msiq_index;
    uint_t      msiq_cnt;
    int     i;

    DBG(DBG_MSIQ, px_p->px_dip, "px_msiq_alloc\n");

    mutex_enter(&msiq_state_p->msiq_mutex);

    if (rec_type == MSG_REC) {
        msiq_cnt = msiq_state_p->msiq_msg_qcnt;
        first_msiq_id = msiq_state_p->msiq_1st_msg_qid;
        next_msiq_index = &msiq_state_p->msiq_next_msg_qid;
    } else {
        msiq_cnt = msiq_state_p->msiq_msi_qcnt;
        first_msiq_id = msiq_state_p->msiq_1st_msi_qid;
        next_msiq_index = &msiq_state_p->msiq_next_msi_qid;
    }

    /* Allocate MSIQs */
    for (i = first_msiq_id; i < (first_msiq_id + msiq_cnt); i++) {
        if (msiq_state_p->msiq_p[i].msiq_state == MSIQ_STATE_FREE) {
            msiq_state_p->msiq_p[i].msiq_state = MSIQ_STATE_INUSE;
            break;
        }
    }

    /*
     * There are no free MSIQ.
     * Use next available MSIQ.
     */
    if (i >= (first_msiq_id + msiq_cnt))
        i = *next_msiq_index;

    *msiq_id_p = msiq_state_p->msiq_p[i].msiq_id;
    DBG(DBG_MSIQ, px_p->px_dip,
        "px_msiq_alloc: msiq_id 0x%x\n", *msiq_id_p);

    (*next_msiq_index)++;

    if (*next_msiq_index >= (first_msiq_id + msiq_cnt))
        *next_msiq_index = first_msiq_id;

    mutex_exit(&msiq_state_p->msiq_mutex);
    return (DDI_SUCCESS);
}

/*
 * px_msiq_free()
 */
int
px_msiq_free(px_t *px_p, msiqid_t msiq_id)
{
    px_msiq_state_t *msiq_state_p = &px_p->px_ib_p->ib_msiq_state;
    int     i, ret = DDI_SUCCESS;

    DBG(DBG_MSIQ, px_p->px_dip, "px_msiq_free: msiq_id 0x%x", msiq_id);

    mutex_enter(&msiq_state_p->msiq_mutex);

    for (i = 0; i < msiq_state_p->msiq_cnt; i++) {
        if (msiq_state_p->msiq_p[i].msiq_id == msiq_id) {
            msiq_state_p->msiq_p[i].msiq_curr =
                msiq_state_p->msiq_p[i].msiq_base;
            msiq_state_p->msiq_p[i].msiq_state = MSIQ_STATE_FREE;
            break;
        }
    }

    if (i >= msiq_state_p->msiq_cnt) {
        DBG(DBG_MSIQ, px_p->px_dip,
            "px_msiq_free: Invalid msiq_id 0x%x", msiq_id);
        ret = DDI_FAILURE;
    }

    mutex_exit(&msiq_state_p->msiq_mutex);
    return (ret);
}

/*
 * px_msiqid_to_devino()
 */
devino_t
px_msiqid_to_devino(px_t *px_p, msiqid_t msiq_id)
{
    px_msiq_state_t *msiq_state_p = &px_p->px_ib_p->ib_msiq_state;
    devino_t    devino;

    devino = msiq_state_p->msiq_1st_devino +
        msiq_id - msiq_state_p->msiq_1st_msiq_id;

    DBG(DBG_MSIQ, px_p->px_dip, "px_msiqid_to_devino: "
        "msiq_id 0x%x devino 0x%x\n", msiq_id, devino);

    return (devino);
}

/*
 * px_devino_to_msiqid()
 */
msiqid_t
px_devino_to_msiqid(px_t *px_p, devino_t devino)
{
    px_msiq_state_t *msiq_state_p = &px_p->px_ib_p->ib_msiq_state;
    msiqid_t    msiq_id;

    msiq_id = msiq_state_p->msiq_1st_msiq_id +
        devino - msiq_state_p->msiq_1st_devino;

    DBG(DBG_MSIQ, px_p->px_dip, "px_devino_to_msiq: "
        "devino 0x%x msiq_id 0x%x\n", devino, msiq_id);

    return (msiq_id);
}

/*
 * px_msiq_get_props()
 */
static void
px_msiq_get_props(px_t *px_p)
{
    px_msiq_state_t *msiq_state_p = &px_p->px_ib_p->ib_msiq_state;
    int ret = DDI_SUCCESS;
    int length = sizeof (int);
    char    *valuep = NULL;

    DBG(DBG_MSIQ, px_p->px_dip, "px_msiq_get_props\n");

    /* #msi-eqs */
    msiq_state_p->msiq_cnt = ddi_getprop(DDI_DEV_T_ANY, px_p->px_dip,
        DDI_PROP_DONTPASS, "#msi-eqs", PX_DEFAULT_MSIQ_CNT);

    DBG(DBG_MSIQ, px_p->px_dip, "obp: msiq_cnt=%d\n",
        msiq_state_p->msiq_cnt);

    /* msi-eq-size */
    msiq_state_p->msiq_rec_cnt = ddi_getprop(DDI_DEV_T_ANY, px_p->px_dip,
        DDI_PROP_DONTPASS, "msi-eq-size", PX_DEFAULT_MSIQ_REC_CNT);

    DBG(DBG_MSIQ, px_p->px_dip, "obp: msiq_rec_cnt=%d\n",
        msiq_state_p->msiq_rec_cnt);

    /* msi-eq-to-devino: msi-eq#, devino# fields */
    ret = ddi_prop_op(DDI_DEV_T_ANY, px_p->px_dip, PROP_LEN_AND_VAL_ALLOC,
        DDI_PROP_DONTPASS, "msi-eq-to-devino", (caddr_t)&valuep,
        &length);

    if (ret == DDI_PROP_SUCCESS) {
        msiq_state_p->msiq_1st_msiq_id =
            ((px_msi_eq_to_devino_t *)valuep)->msi_eq_no;
        msiq_state_p->msiq_1st_devino =
            ((px_msi_eq_to_devino_t *)valuep)->devino_no;
        kmem_free(valuep, (size_t)length);
    } else {
        msiq_state_p->msiq_1st_msiq_id = PX_DEFAULT_MSIQ_1ST_MSIQ_ID;
        msiq_state_p->msiq_1st_devino = PX_DEFAULT_MSIQ_1ST_DEVINO;
    }

    DBG(DBG_MSIQ, px_p->px_dip, "obp: msiq_1st_msiq_id=%d\n",
        msiq_state_p->msiq_1st_msiq_id);

    DBG(DBG_MSIQ, px_p->px_dip, "obp: msiq_1st_devino=%d\n",
        msiq_state_p->msiq_1st_devino);
}