/*
 * 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.
 */

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <stropts.h>
#include <errno.h>
#include <sys/sysmacros.h>
#include <sys/socket.h>
#include <sys/sockio.h>
#include <netinet/in.h>

int
getsourcefilter(int s, uint32_t interface, struct sockaddr *group,
    socklen_t grouplen, uint32_t *fmode, uint_t *numsrc,
    struct sockaddr_storage *slist)
{
        struct group_filter *gf;
        int mallocsize, orig_numsrc, cpsize, rtnerr;

        mallocsize = (*numsrc == 0) ?
            sizeof (struct group_filter) : GROUP_FILTER_SIZE(*numsrc);
        gf = (struct group_filter *)malloc(mallocsize);
        if (gf == NULL) {
                errno = ENOMEM;
                return (-1);
        }

        gf->gf_interface = interface;
        gf->gf_numsrc = orig_numsrc = *numsrc;
        switch (group->sa_family) {
        case AF_INET:
                if (grouplen < sizeof (struct sockaddr_in)) {
                        rtnerr = ENOPROTOOPT;
                        goto done;
                }
                (void) memcpy((void *)&gf->gf_group, (void *)group,
                    sizeof (struct sockaddr_in));
                break;
        case AF_INET6:
                if (grouplen < sizeof (struct sockaddr_in6)) {
                        rtnerr = ENOPROTOOPT;
                        goto done;
                }
                (void) memcpy((void *)&gf->gf_group, (void *)group,
                    sizeof (struct sockaddr_in6));
                break;
        default:
                rtnerr = EAFNOSUPPORT;
                goto done;
        }

        rtnerr = ioctl(s, SIOCGMSFILTER, (void *)gf);
        if (rtnerr == -1) {
                rtnerr = errno;
                goto done;
        }

        *fmode = gf->gf_fmode;
        *numsrc = gf->gf_numsrc;
        cpsize = MIN(orig_numsrc, *numsrc) * sizeof (struct sockaddr_storage);
        (void) memcpy((void *)slist, (void *)gf->gf_slist, cpsize);

done:
        free(gf);
        errno = rtnerr;
        if (errno != 0)
                return (-1);

        return (0);
}

int
setsourcefilter(int s, uint32_t interface, struct sockaddr *group,
    socklen_t grouplen, uint32_t fmode, uint_t numsrc,
    struct sockaddr_storage *slist)
{
        struct group_filter *gf;
        int mallocsize, rtnerr;

        mallocsize = (numsrc == 0) ?
            sizeof (struct group_filter) : GROUP_FILTER_SIZE(numsrc);
        gf = (struct group_filter *)malloc(mallocsize);
        if (gf == NULL) {
                errno = ENOMEM;
                return (-1);
        }

        switch (group->sa_family) {
        case AF_INET:
                if (grouplen < sizeof (struct sockaddr_in)) {
                        rtnerr = ENOPROTOOPT;
                        goto done;
                }
                (void) memcpy((void *)&gf->gf_group, (void *)group,
                    sizeof (struct sockaddr_in));
                break;
        case AF_INET6:
                if (grouplen < sizeof (struct sockaddr_in6)) {
                        rtnerr = ENOPROTOOPT;
                        goto done;
                }
                (void) memcpy((void *)&gf->gf_group, (void *)group,
                    sizeof (struct sockaddr_in6));
                break;
        default:
                rtnerr = EAFNOSUPPORT;
                goto done;
        }
        gf->gf_interface = interface;
        gf->gf_fmode = fmode;
        gf->gf_numsrc = numsrc;
        (void) memcpy((void *)gf->gf_slist, (void *)slist,
            (numsrc * sizeof (struct sockaddr_storage)));

        rtnerr = ioctl(s, SIOCSMSFILTER, (void *)gf);
        if (rtnerr == -1) {
                rtnerr = errno;
        }

done:
        free(gf);
        errno = rtnerr;
        if (errno != 0)
                return (-1);

        return (0);
}

int
getipv4sourcefilter(int s, struct in_addr interface, struct in_addr group,
    uint32_t *fmode, uint32_t *numsrc, struct in_addr *slist)
{
        struct ip_msfilter *imsf;
        int mallocsize, orig_numsrc, cpsize, rtnerr;

        mallocsize = (*numsrc == 0) ?
            sizeof (struct ip_msfilter) : IP_MSFILTER_SIZE(*numsrc);
        imsf = (struct ip_msfilter *)malloc(mallocsize);
        if (imsf == NULL) {
                errno = ENOMEM;
                return (-1);
        }

        imsf->imsf_interface = interface;
        imsf->imsf_numsrc = orig_numsrc = *numsrc;
        imsf->imsf_multiaddr = group;

        rtnerr = ioctl(s, SIOCGIPMSFILTER, (void *)imsf);
        if (rtnerr == -1) {
                rtnerr = errno;
                goto done;
        }

        *fmode = imsf->imsf_fmode;
        *numsrc = imsf->imsf_numsrc;
        cpsize = MIN(orig_numsrc, *numsrc) * sizeof (struct in_addr);
        (void) memcpy((void *)slist, (void *)imsf->imsf_slist, cpsize);

done:
        free(imsf);
        errno = rtnerr;
        if (errno != 0)
                return (-1);

        return (0);
}

int
setipv4sourcefilter(int s, struct in_addr interface, struct in_addr group,
    uint32_t fmode, uint32_t numsrc, struct in_addr *slist)
{
        struct ip_msfilter *imsf;
        int mallocsize, rtnerr;

        mallocsize = (numsrc == 0) ?
            sizeof (struct ip_msfilter) : IP_MSFILTER_SIZE(numsrc);
        imsf = (struct ip_msfilter *)malloc(mallocsize);
        if (imsf == NULL) {
                errno = ENOMEM;
                return (-1);
        }

        imsf->imsf_multiaddr = group;
        imsf->imsf_interface = interface;
        imsf->imsf_fmode = fmode;
        imsf->imsf_numsrc = numsrc;
        (void) memcpy((void *)imsf->imsf_slist, (void *)slist,
            (numsrc * sizeof (struct in_addr)));

        rtnerr = ioctl(s, SIOCSIPMSFILTER, (void *)imsf);
        if (rtnerr == -1) {
                rtnerr = errno;
        }

        free(imsf);
        errno = rtnerr;
        if (errno != 0)
                return (-1);

        return (0);
}