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 GARP VLAN Registration Protocol (GVRP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * 	Copyright (c) 2008 Patrick McHardy <kaber@trash.net>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <linux/if_vlan.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #include <net/garp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include "vlan.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #define GARP_GVRP_ADDRESS	{ 0x01, 0x80, 0xc2, 0x00, 0x00, 0x21 }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) enum gvrp_attributes {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 	GVRP_ATTR_INVALID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	GVRP_ATTR_VID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	__GVRP_ATTR_MAX
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define GVRP_ATTR_MAX	(__GVRP_ATTR_MAX - 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) static struct garp_application vlan_gvrp_app __read_mostly = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	.proto.group_address	= GARP_GVRP_ADDRESS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	.maxattr		= GVRP_ATTR_MAX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	.type			= GARP_APPLICATION_GVRP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) int vlan_gvrp_request_join(const struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	const struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	__be16 vlan_id = htons(vlan->vlan_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	if (vlan->vlan_proto != htons(ETH_P_8021Q))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	return garp_request_join(vlan->real_dev, &vlan_gvrp_app,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 				 &vlan_id, sizeof(vlan_id), GVRP_ATTR_VID);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) void vlan_gvrp_request_leave(const struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	const struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	__be16 vlan_id = htons(vlan->vlan_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	if (vlan->vlan_proto != htons(ETH_P_8021Q))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	garp_request_leave(vlan->real_dev, &vlan_gvrp_app,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 			   &vlan_id, sizeof(vlan_id), GVRP_ATTR_VID);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) int vlan_gvrp_init_applicant(struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	return garp_init_applicant(dev, &vlan_gvrp_app);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) void vlan_gvrp_uninit_applicant(struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 	garp_uninit_applicant(dev, &vlan_gvrp_app);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) int __init vlan_gvrp_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 	return garp_register_application(&vlan_gvrp_app);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) void vlan_gvrp_uninit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	garp_unregister_application(&vlan_gvrp_app);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) }