Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * net/sched/act_meta_tc_index.c IFE skb->tc_index metadata module
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * copyright Jamal Hadi Salim (2016)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/skbuff.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/rtnetlink.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <net/netlink.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <net/pkt_sched.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <uapi/linux/tc_act/tc_ife.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <net/tc_act/tc_ife.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) static int skbtcindex_encode(struct sk_buff *skb, void *skbdata,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 			     struct tcf_meta_info *e)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	u32 ifetc_index = skb->tc_index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	return ife_encode_meta_u16(ifetc_index, skbdata, e);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) static int skbtcindex_decode(struct sk_buff *skb, void *data, u16 len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	u16 ifetc_index = *(u16 *)data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 	skb->tc_index = ntohs(ifetc_index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) static int skbtcindex_check(struct sk_buff *skb, struct tcf_meta_info *e)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	return ife_check_meta_u16(skb->tc_index, e);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) static struct tcf_meta_ops ife_skbtcindex_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	.metaid = IFE_META_TCINDEX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	.metatype = NLA_U16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	.name = "tc_index",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	.synopsis = "skb tc_index 16 bit metadata",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	.check_presence = skbtcindex_check,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	.encode = skbtcindex_encode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	.decode = skbtcindex_decode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	.get = ife_get_meta_u16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	.alloc = ife_alloc_meta_u16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	.release = ife_release_meta_gen,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 	.validate = ife_validate_meta_u16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 	.owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) static int __init ifetc_index_init_module(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 	return register_ife_op(&ife_skbtcindex_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) static void __exit ifetc_index_cleanup_module(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 	unregister_ife_op(&ife_skbtcindex_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) module_init(ifetc_index_init_module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) module_exit(ifetc_index_cleanup_module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) MODULE_AUTHOR("Jamal Hadi Salim(2016)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) MODULE_DESCRIPTION("Inter-FE skb tc_index metadata module");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) MODULE_ALIAS_IFE_META("tcindex");