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_prio.c IFE skb->priority 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 skbprio_check(struct sk_buff *skb, struct tcf_meta_info *e)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	return ife_check_meta_u32(skb->priority, e);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) static int skbprio_encode(struct sk_buff *skb, void *skbdata,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 			  struct tcf_meta_info *e)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	u32 ifeprio = skb->priority; /* avoid having to cast skb->priority*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	return ife_encode_meta_u32(ifeprio, skbdata, e);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) static int skbprio_decode(struct sk_buff *skb, void *data, u16 len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	u32 ifeprio = *(u32 *)data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	skb->priority = ntohl(ifeprio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	return 0;
^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_prio_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	.metaid = IFE_META_PRIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	.metatype = NLA_U32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	.name = "skbprio",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	.synopsis = "skb prio metadata",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	.check_presence = skbprio_check,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	.encode = skbprio_encode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	.decode = skbprio_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) 	.owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) static int __init ifeprio_init_module(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	return register_ife_op(&ife_prio_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) static void __exit ifeprio_cleanup_module(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 	unregister_ife_op(&ife_prio_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) module_init(ifeprio_init_module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) module_exit(ifeprio_cleanup_module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) MODULE_AUTHOR("Jamal Hadi Salim(2015)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) MODULE_DESCRIPTION("Inter-FE skb prio metadata action");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) MODULE_ALIAS_IFE_META("skbprio");