162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * net/sched/em_u32.c	U32 Ematch
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Authors:	Thomas Graf <tgraf@suug.ch>
662306a36Sopenharmony_ci *		Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * Based on net/sched/cls_u32.c
962306a36Sopenharmony_ci */
1062306a36Sopenharmony_ci
1162306a36Sopenharmony_ci#include <linux/module.h>
1262306a36Sopenharmony_ci#include <linux/types.h>
1362306a36Sopenharmony_ci#include <linux/kernel.h>
1462306a36Sopenharmony_ci#include <linux/skbuff.h>
1562306a36Sopenharmony_ci#include <net/pkt_cls.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_cistatic int em_u32_match(struct sk_buff *skb, struct tcf_ematch *em,
1862306a36Sopenharmony_ci			struct tcf_pkt_info *info)
1962306a36Sopenharmony_ci{
2062306a36Sopenharmony_ci	struct tc_u32_key *key = (struct tc_u32_key *) em->data;
2162306a36Sopenharmony_ci	const unsigned char *ptr = skb_network_header(skb);
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci	if (info) {
2462306a36Sopenharmony_ci		if (info->ptr)
2562306a36Sopenharmony_ci			ptr = info->ptr;
2662306a36Sopenharmony_ci		ptr += (info->nexthdr & key->offmask);
2762306a36Sopenharmony_ci	}
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci	ptr += key->off;
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci	if (!tcf_valid_offset(skb, ptr, sizeof(u32)))
3262306a36Sopenharmony_ci		return 0;
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci	return !(((*(__be32 *) ptr)  ^ key->val) & key->mask);
3562306a36Sopenharmony_ci}
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_cistatic struct tcf_ematch_ops em_u32_ops = {
3862306a36Sopenharmony_ci	.kind	  = TCF_EM_U32,
3962306a36Sopenharmony_ci	.datalen  = sizeof(struct tc_u32_key),
4062306a36Sopenharmony_ci	.match	  = em_u32_match,
4162306a36Sopenharmony_ci	.owner	  = THIS_MODULE,
4262306a36Sopenharmony_ci	.link	  = LIST_HEAD_INIT(em_u32_ops.link)
4362306a36Sopenharmony_ci};
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_cistatic int __init init_em_u32(void)
4662306a36Sopenharmony_ci{
4762306a36Sopenharmony_ci	return tcf_em_register(&em_u32_ops);
4862306a36Sopenharmony_ci}
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_cistatic void __exit exit_em_u32(void)
5162306a36Sopenharmony_ci{
5262306a36Sopenharmony_ci	tcf_em_unregister(&em_u32_ops);
5362306a36Sopenharmony_ci}
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ciMODULE_LICENSE("GPL");
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_cimodule_init(init_em_u32);
5862306a36Sopenharmony_cimodule_exit(exit_em_u32);
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_ciMODULE_ALIAS_TCF_EMATCH(TCF_EM_U32);
61