// SPDX-License-Identifier: GPL-2.0-only
/* Unstable XFRM Helpers for TC-BPF hook
 *
 * These are called from SCHED_CLS BPF programs. Note that it is
 * allowed to break compatibility for these functions since the interface they
 * are exposed through to BPF programs is explicitly unstable.
 */

#include <linux/bpf.h>
#include <linux/btf_ids.h>

#include <net/dst_metadata.h>
#include <net/xfrm.h>

/* bpf_xfrm_info - XFRM metadata information
 *
 * Members:
 * @if_id - XFRM if_id:
 *      Transmit: if_id to be used in policy and state lookups
 *      Receive: if_id of the state matched for the incoming packet
 * @link - Underlying device ifindex:
 *      Transmit: used as the underlying device in VRF routing
 *      Receive: the device on which the packet had been received
 */
struct bpf_xfrm_info {
 u32 if_id;
 int link;
};

__bpf_kfunc_start_defs();

/* bpf_skb_get_xfrm_info - Get XFRM metadata
 *
 * Parameters:
 * @skb_ctx - Pointer to ctx (__sk_buff) in TC program
 *      Cannot be NULL
 * @to  - Pointer to memory to which the metadata will be copied
 *      Cannot be NULL
 */
__bpf_kfunc int bpf_skb_get_xfrm_info(struct __sk_buff *skb_ctx, struct bpf_xfrm_info *to)
{
 struct sk_buff *skb = (struct sk_buff *)skb_ctx;
 struct xfrm_md_info *info;

 info = skb_xfrm_md_info(skb);
 if (!info)
  return -EINVAL;

 to->if_id = info->if_id;
 to->link = info->link;
 return 0;
}

/* bpf_skb_get_xfrm_info - Set XFRM metadata
 *
 * Parameters:
 * @skb_ctx - Pointer to ctx (__sk_buff) in TC program
 *      Cannot be NULL
 * @from - Pointer to memory from which the metadata will be copied
 *      Cannot be NULL
 */
__bpf_kfunc int bpf_skb_set_xfrm_info(struct __sk_buff *skb_ctx, const struct bpf_xfrm_info *from)
{
 struct sk_buff *skb = (struct sk_buff *)skb_ctx;
 struct metadata_dst *md_dst;
 struct xfrm_md_info *info;

 if (unlikely(skb_metadata_dst(skb)))
  return -EINVAL;

 if (!xfrm_bpf_md_dst) {
  struct metadata_dst __percpu *tmp;

  tmp = metadata_dst_alloc_percpu(0, METADATA_XFRM, GFP_ATOMIC);
  if (!tmp)
   return -ENOMEM;
  if (cmpxchg(&xfrm_bpf_md_dst, NULL, tmp))
   metadata_dst_free_percpu(tmp);
 }
 md_dst = this_cpu_ptr(xfrm_bpf_md_dst);

 info = &md_dst->u.xfrm_info;

 info->if_id = from->if_id;
 info->link = from->link;
 skb_dst_force(skb);
 info->dst_orig = skb_dst(skb);

 dst_hold((struct dst_entry *)md_dst);
 skb_dst_set(skb, (struct dst_entry *)md_dst);
 return 0;
}

__bpf_kfunc_end_defs();

BTF_KFUNCS_START(xfrm_ifc_kfunc_set)
BTF_ID_FLAGS(func, bpf_skb_get_xfrm_info)
BTF_ID_FLAGS(func, bpf_skb_set_xfrm_info)
BTF_KFUNCS_END(xfrm_ifc_kfunc_set)

static const struct btf_kfunc_id_set xfrm_interface_kfunc_set = {
 .owner = THIS_MODULE,
 .set   = &xfrm_ifc_kfunc_set,
};

int __init register_xfrm_interface_bpf(void)
{
 return register_btf_kfunc_id_set(BPF_PROG_TYPE_SCHED_CLS,
      &xfrm_interface_kfunc_set);
}