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_mark.c IFE skb->mark 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 (2015)
^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 skbmark_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 ifemark = skb->mark;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	return ife_encode_meta_u32(ifemark, 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 skbmark_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) 	u32 ifemark = *(u32 *)data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 	skb->mark = ntohl(ifemark);
^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 skbmark_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_u32(skb->mark, 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_skbmark_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	.metaid = IFE_META_SKBMARK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	.metatype = NLA_U32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	.name = "skbmark",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	.synopsis = "skb mark 32 bit metadata",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	.check_presence = skbmark_check,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	.encode = skbmark_encode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	.decode = skbmark_decode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	.get = ife_get_meta_u32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	.alloc = ife_alloc_meta_u32,
^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_u32,
^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 ifemark_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_skbmark_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 ifemark_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_skbmark_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(ifemark_init_module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) module_exit(ifemark_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(2015)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) MODULE_DESCRIPTION("Inter-FE skb mark 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("skbmark");