sun4v/io/vnet_common.c

/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License (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 2008 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

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

#include <sys/types.h>
#include <sys/ethernet.h>
#include <sys/vnet_common.h>
#include <sys/vlan.h>
#include <sys/stream.h>
#include <sys/strsun.h>
#include <sys/byteorder.h>

/* convert mac address from string to uint64_t */
uint64_t
vnet_macaddr_strtoul(const uint8_t *macaddr)
{
    uint64_t val = 0;
    int i;

    for (i = 0; i < ETHERADDRL; i++) {
        val <<= 8;
        val |= macaddr[i];
    }

    return (val);
}

/* convert mac address from uint64_t to string */
void
vnet_macaddr_ultostr(uint64_t val, uint8_t *macaddr)
{
    int i;
    uint64_t value;

    value = val;
    for (i = ETHERADDRL - 1; i >= 0; i--) {
        macaddr[i] = value & 0xFF;
        value >>= 8;
    }
}

mblk_t *
vnet_vlan_insert_tag(mblk_t *mp, uint16_t vid)
{
    struct ether_vlan_header    *evhp;
    mblk_t              *nmp;
    size_t              n;
    uint_t              pri = 0;

    if (DB_REF(mp) == 1 && MBLKHEAD(mp) >= VLAN_TAGSZ) {

        /* mblk has space to insert tag */

        /*
         * move src and dst mac addrs in the header back by VLAN_TAGSZ.
         */
        ovbcopy(mp->b_rptr, mp->b_rptr - VLAN_TAGSZ, 2 * ETHERADDRL);
        mp->b_rptr -= VLAN_TAGSZ;

        /* now insert tpid and tci */
        evhp = (struct ether_vlan_header *)mp->b_rptr;
        evhp->ether_tpid = htons(ETHERTYPE_VLAN);
        evhp->ether_tci = htons(VLAN_TCI(pri, ETHER_CFI, vid));

    } else { /* no space in the mblk for tag */

        /*
         * allocate a mblk to create a new frame hdr with the tag
         */
        nmp = allocb(sizeof (struct  ether_vlan_header),
            BPRI_MED);
        if (nmp == NULL) {
            freemsg(mp);
            return (NULL);
        }

        /*
         * copy the src and dst mac addrs in the header to the new mblk
         */
        n = 2 * ETHERADDRL;
        bcopy(mp->b_rptr, nmp->b_rptr, n);

        /* initialize the vlan tag in the new mblk */
        evhp = (struct ether_vlan_header *)nmp->b_rptr;
        evhp->ether_tpid = htons(ETHERTYPE_VLAN);
        evhp->ether_tci = htons(VLAN_TCI(pri, ETHER_CFI, vid));

        /* copy ethertype to new mblk */
        bcopy(mp->b_rptr + n, nmp->b_rptr + n + VLAN_TAGSZ,
            sizeof (evhp->ether_type));

        /* skip over the header in the original mblk */
        mp->b_rptr += sizeof (struct ether_header);

        /* fix the end of frame header in the new mblk */
        nmp->b_wptr += sizeof (struct ether_vlan_header);

        /*
         * now link the new mblk which contains just the frame
         * header with the original mblk which contains rest of
         * the frame.
         */
        nmp->b_cont = mp;
        mp = nmp;

    }

    return (mp);
}

mblk_t *
vnet_vlan_remove_tag(mblk_t *mp)
{
    size_t              n;
    mblk_t              *nmp;

    if (DB_REF(mp) == 1) { /* mblk can be modified to untag(not shared) */

        /* move src & dst addrs in the header forward by VLAN_TAGSZ */
        ovbcopy(mp->b_rptr, mp->b_rptr + VLAN_TAGSZ, 2 * ETHERADDRL);
        mp->b_rptr += VLAN_TAGSZ;

    } else {

        /* allocate a new header */
        nmp = allocb(sizeof (struct  ether_header), BPRI_MED);
        if (nmp == NULL) {
            freemsg(mp);
            return (NULL);
        }

        /*
         * copy the src and dst mac addrs in the header to the new mblk
         */
        n = 2 * ETHERADDRL;
        bcopy(mp->b_rptr, nmp->b_rptr, n);

        /* skip over vlan tag and copy ethertype to new mblk */
        bcopy(mp->b_rptr + n + VLAN_TAGSZ, nmp->b_rptr + n,
            sizeof (uint16_t));

        /* skip over the header in the original mblk */
        mp->b_rptr += sizeof (struct ether_vlan_header);

        /* fix the end of frame header in the new mblk */
        nmp->b_wptr += sizeof (struct ether_header);

        /*
         * now link the new mblk which contains the frame header
         * without vlan tag and the original mblk which contains rest
         * of the frame.
         */
        nmp->b_cont = mp;
        mp = nmp;

    }

    return (mp);
}

int
vnet_dring_entry_copy(vnet_public_desc_t *from, vnet_public_desc_t *to,
    uint8_t mtype, ldc_dring_handle_t handle, uint64_t start, uint64_t stop)
{
    int rv;
    on_trap_data_t otd;

    if ((rv = VIO_DRING_ACQUIRE(&otd, mtype, handle, start, stop)) != 0)
        return (rv);

    *to = *from;

    rv = VIO_DRING_RELEASE_NOCOPYOUT(mtype);

    return (rv);
}

int
vnet_dring_entry_set_dstate(vnet_public_desc_t *descp, uint8_t mtype,
    ldc_dring_handle_t handle, uint64_t start, uint64_t stop, uint8_t dstate)
{
    int rv;
    on_trap_data_t otd;

    rv = VIO_DRING_ACQUIRE_NOCOPYIN(&otd, mtype);
    if (rv)
        return (rv);

    descp->hdr.dstate = dstate;

    rv = VIO_DRING_RELEASE(mtype, handle, start, stop);

    return (rv);
}