18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci *	IEEE 802.1Q Multiple VLAN Registration Protocol (MVRP)
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci *	Copyright (c) 2012 Massachusetts Institute of Technology
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci *	Adapted from code in net/8021q/vlan_gvrp.c
88c2ecf20Sopenharmony_ci *	Copyright (c) 2008 Patrick McHardy <kaber@trash.net>
98c2ecf20Sopenharmony_ci */
108c2ecf20Sopenharmony_ci#include <linux/types.h>
118c2ecf20Sopenharmony_ci#include <linux/if_ether.h>
128c2ecf20Sopenharmony_ci#include <linux/if_vlan.h>
138c2ecf20Sopenharmony_ci#include <net/mrp.h>
148c2ecf20Sopenharmony_ci#include "vlan.h"
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_ci#define MRP_MVRP_ADDRESS	{ 0x01, 0x80, 0xc2, 0x00, 0x00, 0x21 }
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_cienum mvrp_attributes {
198c2ecf20Sopenharmony_ci	MVRP_ATTR_INVALID,
208c2ecf20Sopenharmony_ci	MVRP_ATTR_VID,
218c2ecf20Sopenharmony_ci	__MVRP_ATTR_MAX
228c2ecf20Sopenharmony_ci};
238c2ecf20Sopenharmony_ci#define MVRP_ATTR_MAX	(__MVRP_ATTR_MAX - 1)
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_cistatic struct mrp_application vlan_mrp_app __read_mostly = {
268c2ecf20Sopenharmony_ci	.type		= MRP_APPLICATION_MVRP,
278c2ecf20Sopenharmony_ci	.maxattr	= MVRP_ATTR_MAX,
288c2ecf20Sopenharmony_ci	.pkttype.type	= htons(ETH_P_MVRP),
298c2ecf20Sopenharmony_ci	.group_address	= MRP_MVRP_ADDRESS,
308c2ecf20Sopenharmony_ci	.version	= 0,
318c2ecf20Sopenharmony_ci};
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_ciint vlan_mvrp_request_join(const struct net_device *dev)
348c2ecf20Sopenharmony_ci{
358c2ecf20Sopenharmony_ci	const struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
368c2ecf20Sopenharmony_ci	__be16 vlan_id = htons(vlan->vlan_id);
378c2ecf20Sopenharmony_ci
388c2ecf20Sopenharmony_ci	if (vlan->vlan_proto != htons(ETH_P_8021Q))
398c2ecf20Sopenharmony_ci		return 0;
408c2ecf20Sopenharmony_ci	return mrp_request_join(vlan->real_dev, &vlan_mrp_app,
418c2ecf20Sopenharmony_ci				&vlan_id, sizeof(vlan_id), MVRP_ATTR_VID);
428c2ecf20Sopenharmony_ci}
438c2ecf20Sopenharmony_ci
448c2ecf20Sopenharmony_civoid vlan_mvrp_request_leave(const struct net_device *dev)
458c2ecf20Sopenharmony_ci{
468c2ecf20Sopenharmony_ci	const struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
478c2ecf20Sopenharmony_ci	__be16 vlan_id = htons(vlan->vlan_id);
488c2ecf20Sopenharmony_ci
498c2ecf20Sopenharmony_ci	if (vlan->vlan_proto != htons(ETH_P_8021Q))
508c2ecf20Sopenharmony_ci		return;
518c2ecf20Sopenharmony_ci	mrp_request_leave(vlan->real_dev, &vlan_mrp_app,
528c2ecf20Sopenharmony_ci			  &vlan_id, sizeof(vlan_id), MVRP_ATTR_VID);
538c2ecf20Sopenharmony_ci}
548c2ecf20Sopenharmony_ci
558c2ecf20Sopenharmony_ciint vlan_mvrp_init_applicant(struct net_device *dev)
568c2ecf20Sopenharmony_ci{
578c2ecf20Sopenharmony_ci	return mrp_init_applicant(dev, &vlan_mrp_app);
588c2ecf20Sopenharmony_ci}
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_civoid vlan_mvrp_uninit_applicant(struct net_device *dev)
618c2ecf20Sopenharmony_ci{
628c2ecf20Sopenharmony_ci	mrp_uninit_applicant(dev, &vlan_mrp_app);
638c2ecf20Sopenharmony_ci}
648c2ecf20Sopenharmony_ci
658c2ecf20Sopenharmony_ciint __init vlan_mvrp_init(void)
668c2ecf20Sopenharmony_ci{
678c2ecf20Sopenharmony_ci	return mrp_register_application(&vlan_mrp_app);
688c2ecf20Sopenharmony_ci}
698c2ecf20Sopenharmony_ci
708c2ecf20Sopenharmony_civoid vlan_mvrp_uninit(void)
718c2ecf20Sopenharmony_ci{
728c2ecf20Sopenharmony_ci	mrp_unregister_application(&vlan_mrp_app);
738c2ecf20Sopenharmony_ci}
74