2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy/*
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * CDDL HEADER START
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy *
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * The contents of this file are subject to the terms of the
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * Common Development and Distribution License (the "License").
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * You may not use this file except in compliance with the License.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy *
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * or http://www.opensolaris.org/os/licensing.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * See the License for the specific language governing permissions
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * and limitations under the License.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy *
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * When distributing Covered Code, include this CDDL HEADER in each
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * If applicable, add the following below this CDDL HEADER, with the
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * fields enclosed by brackets "[]" replaced with your own identifying
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * information: Portions Copyright [yyyy] [name of copyright owner]
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy *
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * CDDL HEADER END
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy/*
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * Copyright 2009 Sun Microsystems, Inc. All rights reserved.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * Use is subject to license terms.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy/*
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * DL_IPV6 MAC Type plugin for the Nemo mac module
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <sys/types.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <sys/modctl.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <sys/dlpi.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <sys/mac.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <sys/mac_ipv6.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <sys/mac_ipv4_impl.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <sys/byteorder.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <sys/strsun.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <netinet/ip6.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <inet/common.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <inet/mib2.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <inet/ip.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <inet/ip6.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy#include <inet/iptun.h>
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roystatic struct modlmisc mac_ipv6_modlmisc = {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy &mod_miscops,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy "IPv6 tunneling MAC plugin"
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy};
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roystatic struct modlinkage mac_ipv6_modlinkage = {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy MODREV_1,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy &mac_ipv6_modlmisc,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy NULL
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy};
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roystatic mactype_ops_t mac_ipv6_type_ops;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Royint
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy_init(void)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy{
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mactype_register_t *mtrp;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy int err;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if ((mtrp = mactype_alloc(MACTYPE_VERSION)) == NULL)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (EINVAL);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mtrp->mtr_ident = MAC_PLUGIN_IDENT_IPV6;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mtrp->mtr_ops = &mac_ipv6_type_ops;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mtrp->mtr_mactype = DL_IPV6;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mtrp->mtr_nativetype = DL_IPV6;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mtrp->mtr_addrlen = sizeof (in6_addr_t);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if ((err = mactype_register(mtrp)) == 0) {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if ((err = mod_install(&mac_ipv6_modlinkage)) != 0)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy (void) mactype_unregister(MAC_PLUGIN_IDENT_IPV6);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy }
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mactype_free(mtrp);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (err);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy}
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Royint
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy_fini(void)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy{
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy int err;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if ((err = mactype_unregister(MAC_PLUGIN_IDENT_IPV6)) != 0)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (err);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (mod_remove(&mac_ipv6_modlinkage));
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy}
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Royint
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy_info(struct modinfo *modinfop)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy{
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (mod_info(&mac_ipv6_modlinkage, modinfop));
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy}
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy/*
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * MAC Type plugin operations
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy/* ARGSUSED */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Royint
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roymac_ipv6_unicst_verify(const void *addr, void *pdata)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy{
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy const in6_addr_t *in6addr = addr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (IN6_IS_ADDR_UNSPECIFIED(in6addr) ||
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy IN6_IS_ADDR_LOOPBACK(in6addr) ||
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy IN6_IS_ADDR_MULTICAST(in6addr) ||
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy IN6_IS_ADDR_V4MAPPED(in6addr) ||
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy IN6_IS_ADDR_V4COMPAT(in6addr)) {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (EINVAL);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy }
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (0);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy}
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy/*
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * Build an IPv6 link-layer header for tunneling. If provided, the
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * template header provided by the driver supplies the traffic class, flow
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * label, hop limit, and potential options. The template's payload length
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * must either be 0 if there are no extension headers, or reflect the size
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * of the extension headers if present. The template's next header value
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * must either be IPPROTO_NONE if no extension headers are present, or
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * reflect the type of extension header that follows (the same is true for
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * the field values of the extension headers themselves.)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy/* ARGSUSED */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roymblk_t *
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roymac_ipv6_header(const void *saddr, const void *daddr, uint32_t sap, void *pdata,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mblk_t *payload, size_t extra_len)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy{
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6_t *ip6hp;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6_t *tmpl_ip6hp = pdata;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mblk_t *mp;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy size_t hdr_len = sizeof (ip6_t);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy uint8_t *nxt_proto;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (!mac_ipv4_sap_verify(sap, NULL, NULL))
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (NULL);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (tmpl_ip6hp != NULL)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy hdr_len = sizeof (ip6_t) + tmpl_ip6hp->ip6_plen;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if ((mp = allocb(hdr_len + extra_len, BPRI_HI)) == NULL)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (NULL);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6hp = (ip6_t *)mp->b_rptr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy bzero(ip6hp, hdr_len + extra_len);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (tmpl_ip6hp != NULL) {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy bcopy(tmpl_ip6hp, ip6hp, hdr_len);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy } else {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6hp->ip6_nxt = IPPROTO_NONE;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6hp->ip6_hlim = IPTUN_DEFAULT_HOPLIMIT;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy }
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6hp->ip6_vcf = IPV6_DEFAULT_VERS_AND_FLOW;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6hp->ip6_plen = 0;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy nxt_proto = &ip6hp->ip6_nxt;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (*nxt_proto != IPPROTO_NONE) {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6_dest_t *hdrptr = (ip6_dest_t *)(ip6hp + 1);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy nxt_proto = &hdrptr->ip6d_nxt;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy while (*nxt_proto != IPPROTO_NONE) {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy hdrptr = (ip6_dest_t *)((uint8_t *)hdrptr +
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy (8 * (hdrptr->ip6d_len + 1)));
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy nxt_proto = &hdrptr->ip6d_nxt;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy }
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy }
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy *nxt_proto = (uint8_t)sap;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy bcopy(saddr, &(ip6hp->ip6_src), sizeof (in6_addr_t));
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy bcopy(daddr, &(ip6hp->ip6_dst), sizeof (in6_addr_t));
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mp->b_wptr += hdr_len;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (mp);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy}
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy/* ARGSUSED */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Royint
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roymac_ipv6_header_info(mblk_t *mp, void *pdata, mac_header_info_t *hdr_info)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy{
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6_t *ip6hp;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy uint8_t *whereptr, *endptr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy uint8_t nexthdr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (MBLKL(mp) < sizeof (ip6_t))
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (EINVAL);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6hp = (ip6_t *)mp->b_rptr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy /*
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * IPv6 tunnels don't have a concept of link-layer multicast since
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * they have fixed unicast endpoints.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (mac_ipv6_unicst_verify(&ip6hp->ip6_dst, NULL) != 0)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (EINVAL);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy nexthdr = ip6hp->ip6_nxt;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy whereptr = (uint8_t *)(ip6hp + 1);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy endptr = mp->b_wptr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy while (nexthdr != IPPROTO_ENCAP && nexthdr != IPPROTO_IPV6) {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6_dest_t *exthdrptr = (ip6_dest_t *)whereptr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (whereptr + sizeof (ip6_dest_t) >= endptr)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (EINVAL);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy nexthdr = exthdrptr->ip6d_nxt;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy whereptr += 8 * (exthdrptr->ip6d_len + 1);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (whereptr > endptr)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (EINVAL);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy }
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy hdr_info->mhi_hdrsize = whereptr - mp->b_rptr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy hdr_info->mhi_pktsize = 0;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy hdr_info->mhi_daddr = (const uint8_t *)&(ip6hp->ip6_dst);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy hdr_info->mhi_saddr = (const uint8_t *)&(ip6hp->ip6_src);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy hdr_info->mhi_bindsap = hdr_info->mhi_origsap = nexthdr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy hdr_info->mhi_dsttype = MAC_ADDRTYPE_UNICAST;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (0);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy}
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy/*
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * This plugin's MAC plugin data is a template IPv6 header followed by
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * optional extension headers. The chain of headers must be terminated by
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * a header with a next header value of IPPROTO_NONE. The payload length
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * of the IPv6 header must be 0 if there are no extension headers, or must
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * reflect the total size of extension headers present.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Royboolean_t
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roymac_ipv6_pdata_verify(void *pdata, size_t pdata_size)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy{
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6_t *ip6hp = pdata;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy uint8_t *whereptr, *endptr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy uint8_t nexthdr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy /*
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * Since the plugin does not require plugin data, it is acceptable
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * for drivers to pass in NULL plugin data as long as the plugin
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * data size is consistent.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (pdata == NULL)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (pdata_size == 0);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy /* First verify that we have enough data to hold an IPv6 header. */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (pdata_size < sizeof (ip6_t))
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (B_FALSE);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy /* Make sure that pdata_size is consistent with the payload length. */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (pdata_size != sizeof (ip6_t) + ip6hp->ip6_plen)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (B_FALSE);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy /*
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * Make sure that the header chain is terminated by a header with a
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy * next header value of IPPROTO_NONE.
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy nexthdr = ip6hp->ip6_nxt;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (nexthdr == IPPROTO_NONE)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (ip6hp->ip6_plen == 0);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy whereptr = (uint8_t *)(ip6hp + 1);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy endptr = (uint8_t *)pdata + pdata_size;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy while (nexthdr != IPPROTO_NONE && whereptr < endptr) {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy ip6_dest_t *hdrptr = (ip6_dest_t *)whereptr;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy /* make sure we're pointing at a complete header */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy if (whereptr + sizeof (ip6_dest_t) > endptr)
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy break;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy nexthdr = hdrptr->ip6d_nxt;
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy whereptr += 8 * (hdrptr->ip6d_len + 1);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy }
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy return (nexthdr == IPPROTO_NONE && whereptr == endptr);
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy}
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roystatic mactype_ops_t mac_ipv6_type_ops = {
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy MTOPS_PDATA_VERIFY,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mac_ipv6_unicst_verify,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mac_ipv4_multicst_verify, /* neither plugin supports multicast */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mac_ipv4_sap_verify, /* same set of legal SAP values */
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mac_ipv6_header,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mac_ipv6_header_info,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy mac_ipv6_pdata_verify,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy NULL,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy NULL,
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy NULL
2b24ab6b3865caeede9eeb9db6b83e1d89dcd1eaSebastien Roy};