/*
* 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);
}