// SPDX-License-Identifier: GPL-2.0-only
/* Unstable Fou 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/fou.h>

struct bpf_fou_encap {
 __be16 sport;
 __be16 dport;
};

enum bpf_fou_encap_type {
 FOU_BPF_ENCAP_FOU,
 FOU_BPF_ENCAP_GUE,
};

__bpf_kfunc_start_defs();

/* bpf_skb_set_fou_encap - Set FOU encap parameters
 *
 * This function allows for using GUE or FOU encapsulation together with an
 * ipip device in collect-metadata mode.
 *
 * It is meant to be used in BPF tc-hooks and after a call to the
 * bpf_skb_set_tunnel_key helper, responsible for setting IP addresses.
 *
 * Parameters:
 * @skb_ctx Pointer to ctx (__sk_buff) in TC program. Cannot be NULL
 * @encap Pointer to a `struct bpf_fou_encap` storing UDP src and
 *   dst ports. If sport is set to 0 the kernel will auto-assign a
 *   port. This is similar to using `encap-sport auto`.
 *   Cannot be NULL
 * @type Encapsulation type for the packet. Their definitions are
 *   specified in `enum bpf_fou_encap_type`
 */
__bpf_kfunc int bpf_skb_set_fou_encap(struct __sk_buff *skb_ctx,
          struct bpf_fou_encap *encap, int type)
{
 struct sk_buff *skb = (struct sk_buff *)skb_ctx;
 struct ip_tunnel_info *info = skb_tunnel_info(skb);

 if (unlikely(!encap))
  return -EINVAL;

 if (unlikely(!info || !(info->mode & IP_TUNNEL_INFO_TX)))
  return -EINVAL;

 switch (type) {
 case FOU_BPF_ENCAP_FOU:
  info->encap.type = TUNNEL_ENCAP_FOU;
  break;
 case FOU_BPF_ENCAP_GUE:
  info->encap.type = TUNNEL_ENCAP_GUE;
  break;
 default:
  info->encap.type = TUNNEL_ENCAP_NONE;
 }

 if (test_bit(IP_TUNNEL_CSUM_BIT, info->key.tun_flags))
  info->encap.flags |= TUNNEL_ENCAP_FLAG_CSUM;

 info->encap.sport = encap->sport;
 info->encap.dport = encap->dport;

 return 0;
}

/* bpf_skb_get_fou_encap - Get FOU encap parameters
 *
 * This function allows for reading encap metadata from a packet received
 * on an ipip device in collect-metadata mode.
 *
 * Parameters:
 * @skb_ctx Pointer to ctx (__sk_buff) in TC program. Cannot be NULL
 * @encap Pointer to a struct bpf_fou_encap storing UDP source and
 *   destination port. Cannot be NULL
 */
__bpf_kfunc int bpf_skb_get_fou_encap(struct __sk_buff *skb_ctx,
          struct bpf_fou_encap *encap)
{
 struct sk_buff *skb = (struct sk_buff *)skb_ctx;
 struct ip_tunnel_info *info = skb_tunnel_info(skb);

 if (unlikely(!info))
  return -EINVAL;

 encap->sport = info->encap.sport;
 encap->dport = info->encap.dport;

 return 0;
}

__bpf_kfunc_end_defs();

BTF_KFUNCS_START(fou_kfunc_set)
BTF_ID_FLAGS(func, bpf_skb_set_fou_encap)
BTF_ID_FLAGS(func, bpf_skb_get_fou_encap)
BTF_KFUNCS_END(fou_kfunc_set)

static const struct btf_kfunc_id_set fou_bpf_kfunc_set = {
 .owner = THIS_MODULE,
 .set   = &fou_kfunc_set,
};

int register_fou_bpf(void)
{
 return register_btf_kfunc_id_set(BPF_PROG_TYPE_SCHED_CLS,
      &fou_bpf_kfunc_set);
}