Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  *	IEEE 802.1Q Multiple VLAN Registration Protocol (MVRP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  *	Copyright (c) 2012 Massachusetts Institute of Technology
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  *	Adapted from code in net/8021q/vlan_gvrp.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8)  *	Copyright (c) 2008 Patrick McHardy <kaber@trash.net>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/if_ether.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/if_vlan.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <net/mrp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include "vlan.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #define MRP_MVRP_ADDRESS	{ 0x01, 0x80, 0xc2, 0x00, 0x00, 0x21 }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) enum mvrp_attributes {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	MVRP_ATTR_INVALID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	MVRP_ATTR_VID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	__MVRP_ATTR_MAX
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #define MVRP_ATTR_MAX	(__MVRP_ATTR_MAX - 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) static struct mrp_application vlan_mrp_app __read_mostly = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	.type		= MRP_APPLICATION_MVRP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	.maxattr	= MVRP_ATTR_MAX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	.pkttype.type	= htons(ETH_P_MVRP),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	.group_address	= MRP_MVRP_ADDRESS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	.version	= 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) int vlan_mvrp_request_join(const struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	const struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	__be16 vlan_id = htons(vlan->vlan_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	if (vlan->vlan_proto != htons(ETH_P_8021Q))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	return mrp_request_join(vlan->real_dev, &vlan_mrp_app,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 				&vlan_id, sizeof(vlan_id), MVRP_ATTR_VID);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) void vlan_mvrp_request_leave(const struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	const struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	__be16 vlan_id = htons(vlan->vlan_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	if (vlan->vlan_proto != htons(ETH_P_8021Q))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	mrp_request_leave(vlan->real_dev, &vlan_mrp_app,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 			  &vlan_id, sizeof(vlan_id), MVRP_ATTR_VID);
^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) int vlan_mvrp_init_applicant(struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	return mrp_init_applicant(dev, &vlan_mrp_app);
^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) void vlan_mvrp_uninit_applicant(struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 	mrp_uninit_applicant(dev, &vlan_mrp_app);
^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) int __init vlan_mvrp_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 	return mrp_register_application(&vlan_mrp_app);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) void vlan_mvrp_uninit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 	mrp_unregister_application(&vlan_mrp_app);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) }