linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * xfrm6_policy.c: based on xfrm4_policy.c

 *

 * Authors:

 *  Mitsuru KANDA @USAGI

 *  Kazunori MIYAZAWA @USAGI

 *  Kunihiro Ishiguro <kunihiro@ipinfusion.com>

 *      IPv6 support

 *  YOSHIFUJI Hideaki

 *      Split up af-specific portion

 *

 */

​

#include <linux/err.h>

#include <linux/kernel.h>

#include <linux/netdevice.h>

#include <net/addrconf.h>

#include <net/dst.h>

#include <net/xfrm.h>

#include <net/ip.h>

#include <net/ipv6.h>

#include <net/ip6_route.h>

#include <net/l3mdev.h>

#if IS_ENABLED(CONFIG_IPV6_MIP6)

#include <net/mip6.h>

#endif

​

static struct dst_entry *xfrm6_dst_lookup(struct net *net, int tos, int oif,

                      const xfrm_address_t *saddr,

                      const xfrm_address_t *daddr,

                      u32 mark)

{

    struct flowi6 fl6;

    struct dst_entry *dst;

    int err;

​

    memset(&fl6, 0, sizeof(fl6));

    fl6.flowi6_oif = l3mdev_master_ifindex_by_index(net, oif);

    fl6.flowi6_flags = FLOWI_FLAG_SKIP_NH_OIF;

    fl6.flowi6_mark = mark;

    memcpy(&fl6.daddr, daddr, sizeof(fl6.daddr));

    if (saddr)

        memcpy(&fl6.saddr, saddr, sizeof(fl6.saddr));

​

    dst = ip6_route_output(net, NULL, &fl6);

​

    err = dst->error;

    if (dst->error) {

        dst_release(dst);

        dst = ERR_PTR(err);

    }

​

    return dst;

}

​

static int xfrm6_get_saddr(struct net *net, int oif,

               xfrm_address_t *saddr, xfrm_address_t *daddr,

               u32 mark)

{

    struct dst_entry *dst;

    struct net_device *dev;

​

    dst = xfrm6_dst_lookup(net, 0, oif, NULL, daddr, mark);

    if (IS_ERR(dst))

        return -EHOSTUNREACH;

​

    dev = ip6_dst_idev(dst)->dev;

    ipv6_dev_get_saddr(dev_net(dev), dev, &daddr->in6, 0, &saddr->in6);

    dst_release(dst);

    return 0;

}

​

static int xfrm6_get_tos(const struct flowi *fl)

{

    return 0;

}

​

static int xfrm6_init_path(struct xfrm_dst *path, struct dst_entry *dst,

               int nfheader_len)

{

    if (dst->ops->family == AF_INET6) {

        struct rt6_info *rt = (struct rt6_info *)dst;

        path->path_cookie = rt6_get_cookie(rt);

    }

​

    path->u.rt6.rt6i_nfheader_len = nfheader_len;

​

    return 0;

}

​

static int xfrm6_fill_dst(struct xfrm_dst *xdst, struct net_device *dev,