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