1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * IEEE 802.1D Generic Attribute Registration Protocol (GARP)
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (c) 2008 Patrick McHardy <kaber@trash.net>
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun #include <linux/kernel.h>
8*4882a593Smuzhiyun #include <linux/timer.h>
9*4882a593Smuzhiyun #include <linux/skbuff.h>
10*4882a593Smuzhiyun #include <linux/netdevice.h>
11*4882a593Smuzhiyun #include <linux/etherdevice.h>
12*4882a593Smuzhiyun #include <linux/rtnetlink.h>
13*4882a593Smuzhiyun #include <linux/llc.h>
14*4882a593Smuzhiyun #include <linux/slab.h>
15*4882a593Smuzhiyun #include <linux/module.h>
16*4882a593Smuzhiyun #include <net/llc.h>
17*4882a593Smuzhiyun #include <net/llc_pdu.h>
18*4882a593Smuzhiyun #include <net/garp.h>
19*4882a593Smuzhiyun #include <asm/unaligned.h>
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun static unsigned int garp_join_time __read_mostly = 200;
22*4882a593Smuzhiyun module_param(garp_join_time, uint, 0644);
23*4882a593Smuzhiyun MODULE_PARM_DESC(garp_join_time, "Join time in ms (default 200ms)");
24*4882a593Smuzhiyun MODULE_LICENSE("GPL");
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun static const struct garp_state_trans {
27*4882a593Smuzhiyun u8 state;
28*4882a593Smuzhiyun u8 action;
29*4882a593Smuzhiyun } garp_applicant_state_table[GARP_APPLICANT_MAX + 1][GARP_EVENT_MAX + 1] = {
30*4882a593Smuzhiyun [GARP_APPLICANT_VA] = {
31*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_AA,
32*4882a593Smuzhiyun .action = GARP_ACTION_S_JOIN_IN },
33*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_AA },
34*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VA },
35*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_VA },
36*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_VA },
37*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VP },
38*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_INVALID },
39*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_LA },
40*4882a593Smuzhiyun },
41*4882a593Smuzhiyun [GARP_APPLICANT_AA] = {
42*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_QA,
43*4882a593Smuzhiyun .action = GARP_ACTION_S_JOIN_IN },
44*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_QA },
45*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VA },
46*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_VA },
47*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_VA },
48*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VP },
49*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_INVALID },
50*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_LA },
51*4882a593Smuzhiyun },
52*4882a593Smuzhiyun [GARP_APPLICANT_QA] = {
53*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_INVALID },
54*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_QA },
55*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VA },
56*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_VA },
57*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_VP },
58*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VP },
59*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_INVALID },
60*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_LA },
61*4882a593Smuzhiyun },
62*4882a593Smuzhiyun [GARP_APPLICANT_LA] = {
63*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_VO,
64*4882a593Smuzhiyun .action = GARP_ACTION_S_LEAVE_EMPTY },
65*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_LA },
66*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VO },
67*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_LA },
68*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_LA },
69*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VO },
70*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_VA },
71*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_INVALID },
72*4882a593Smuzhiyun },
73*4882a593Smuzhiyun [GARP_APPLICANT_VP] = {
74*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_AA,
75*4882a593Smuzhiyun .action = GARP_ACTION_S_JOIN_IN },
76*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_AP },
77*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VP },
78*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_VP },
79*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_VP },
80*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VP },
81*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_INVALID },
82*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_VO },
83*4882a593Smuzhiyun },
84*4882a593Smuzhiyun [GARP_APPLICANT_AP] = {
85*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_QA,
86*4882a593Smuzhiyun .action = GARP_ACTION_S_JOIN_IN },
87*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_QP },
88*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VP },
89*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_VP },
90*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_VP },
91*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VP },
92*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_INVALID },
93*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_AO },
94*4882a593Smuzhiyun },
95*4882a593Smuzhiyun [GARP_APPLICANT_QP] = {
96*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_INVALID },
97*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_QP },
98*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VP },
99*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_VP },
100*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_VP },
101*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VP },
102*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_INVALID },
103*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_QO },
104*4882a593Smuzhiyun },
105*4882a593Smuzhiyun [GARP_APPLICANT_VO] = {
106*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_INVALID },
107*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_AO },
108*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VO },
109*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_VO },
110*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_VO },
111*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VO },
112*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_VP },
113*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_INVALID },
114*4882a593Smuzhiyun },
115*4882a593Smuzhiyun [GARP_APPLICANT_AO] = {
116*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_INVALID },
117*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_QO },
118*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VO },
119*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_VO },
120*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_VO },
121*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VO },
122*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_AP },
123*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_INVALID },
124*4882a593Smuzhiyun },
125*4882a593Smuzhiyun [GARP_APPLICANT_QO] = {
126*4882a593Smuzhiyun [GARP_EVENT_TRANSMIT_PDU] = { .state = GARP_APPLICANT_INVALID },
127*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_IN] = { .state = GARP_APPLICANT_QO },
128*4882a593Smuzhiyun [GARP_EVENT_R_JOIN_EMPTY] = { .state = GARP_APPLICANT_VO },
129*4882a593Smuzhiyun [GARP_EVENT_R_EMPTY] = { .state = GARP_APPLICANT_VO },
130*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_IN] = { .state = GARP_APPLICANT_VO },
131*4882a593Smuzhiyun [GARP_EVENT_R_LEAVE_EMPTY] = { .state = GARP_APPLICANT_VO },
132*4882a593Smuzhiyun [GARP_EVENT_REQ_JOIN] = { .state = GARP_APPLICANT_QP },
133*4882a593Smuzhiyun [GARP_EVENT_REQ_LEAVE] = { .state = GARP_APPLICANT_INVALID },
134*4882a593Smuzhiyun },
135*4882a593Smuzhiyun };
136*4882a593Smuzhiyun
garp_attr_cmp(const struct garp_attr * attr,const void * data,u8 len,u8 type)137*4882a593Smuzhiyun static int garp_attr_cmp(const struct garp_attr *attr,
138*4882a593Smuzhiyun const void *data, u8 len, u8 type)
139*4882a593Smuzhiyun {
140*4882a593Smuzhiyun if (attr->type != type)
141*4882a593Smuzhiyun return attr->type - type;
142*4882a593Smuzhiyun if (attr->dlen != len)
143*4882a593Smuzhiyun return attr->dlen - len;
144*4882a593Smuzhiyun return memcmp(attr->data, data, len);
145*4882a593Smuzhiyun }
146*4882a593Smuzhiyun
garp_attr_lookup(const struct garp_applicant * app,const void * data,u8 len,u8 type)147*4882a593Smuzhiyun static struct garp_attr *garp_attr_lookup(const struct garp_applicant *app,
148*4882a593Smuzhiyun const void *data, u8 len, u8 type)
149*4882a593Smuzhiyun {
150*4882a593Smuzhiyun struct rb_node *parent = app->gid.rb_node;
151*4882a593Smuzhiyun struct garp_attr *attr;
152*4882a593Smuzhiyun int d;
153*4882a593Smuzhiyun
154*4882a593Smuzhiyun while (parent) {
155*4882a593Smuzhiyun attr = rb_entry(parent, struct garp_attr, node);
156*4882a593Smuzhiyun d = garp_attr_cmp(attr, data, len, type);
157*4882a593Smuzhiyun if (d > 0)
158*4882a593Smuzhiyun parent = parent->rb_left;
159*4882a593Smuzhiyun else if (d < 0)
160*4882a593Smuzhiyun parent = parent->rb_right;
161*4882a593Smuzhiyun else
162*4882a593Smuzhiyun return attr;
163*4882a593Smuzhiyun }
164*4882a593Smuzhiyun return NULL;
165*4882a593Smuzhiyun }
166*4882a593Smuzhiyun
garp_attr_create(struct garp_applicant * app,const void * data,u8 len,u8 type)167*4882a593Smuzhiyun static struct garp_attr *garp_attr_create(struct garp_applicant *app,
168*4882a593Smuzhiyun const void *data, u8 len, u8 type)
169*4882a593Smuzhiyun {
170*4882a593Smuzhiyun struct rb_node *parent = NULL, **p = &app->gid.rb_node;
171*4882a593Smuzhiyun struct garp_attr *attr;
172*4882a593Smuzhiyun int d;
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun while (*p) {
175*4882a593Smuzhiyun parent = *p;
176*4882a593Smuzhiyun attr = rb_entry(parent, struct garp_attr, node);
177*4882a593Smuzhiyun d = garp_attr_cmp(attr, data, len, type);
178*4882a593Smuzhiyun if (d > 0)
179*4882a593Smuzhiyun p = &parent->rb_left;
180*4882a593Smuzhiyun else if (d < 0)
181*4882a593Smuzhiyun p = &parent->rb_right;
182*4882a593Smuzhiyun else {
183*4882a593Smuzhiyun /* The attribute already exists; re-use it. */
184*4882a593Smuzhiyun return attr;
185*4882a593Smuzhiyun }
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun attr = kmalloc(sizeof(*attr) + len, GFP_ATOMIC);
188*4882a593Smuzhiyun if (!attr)
189*4882a593Smuzhiyun return attr;
190*4882a593Smuzhiyun attr->state = GARP_APPLICANT_VO;
191*4882a593Smuzhiyun attr->type = type;
192*4882a593Smuzhiyun attr->dlen = len;
193*4882a593Smuzhiyun memcpy(attr->data, data, len);
194*4882a593Smuzhiyun
195*4882a593Smuzhiyun rb_link_node(&attr->node, parent, p);
196*4882a593Smuzhiyun rb_insert_color(&attr->node, &app->gid);
197*4882a593Smuzhiyun return attr;
198*4882a593Smuzhiyun }
199*4882a593Smuzhiyun
garp_attr_destroy(struct garp_applicant * app,struct garp_attr * attr)200*4882a593Smuzhiyun static void garp_attr_destroy(struct garp_applicant *app, struct garp_attr *attr)
201*4882a593Smuzhiyun {
202*4882a593Smuzhiyun rb_erase(&attr->node, &app->gid);
203*4882a593Smuzhiyun kfree(attr);
204*4882a593Smuzhiyun }
205*4882a593Smuzhiyun
garp_attr_destroy_all(struct garp_applicant * app)206*4882a593Smuzhiyun static void garp_attr_destroy_all(struct garp_applicant *app)
207*4882a593Smuzhiyun {
208*4882a593Smuzhiyun struct rb_node *node, *next;
209*4882a593Smuzhiyun struct garp_attr *attr;
210*4882a593Smuzhiyun
211*4882a593Smuzhiyun for (node = rb_first(&app->gid);
212*4882a593Smuzhiyun next = node ? rb_next(node) : NULL, node != NULL;
213*4882a593Smuzhiyun node = next) {
214*4882a593Smuzhiyun attr = rb_entry(node, struct garp_attr, node);
215*4882a593Smuzhiyun garp_attr_destroy(app, attr);
216*4882a593Smuzhiyun }
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun
garp_pdu_init(struct garp_applicant * app)219*4882a593Smuzhiyun static int garp_pdu_init(struct garp_applicant *app)
220*4882a593Smuzhiyun {
221*4882a593Smuzhiyun struct sk_buff *skb;
222*4882a593Smuzhiyun struct garp_pdu_hdr *gp;
223*4882a593Smuzhiyun
224*4882a593Smuzhiyun #define LLC_RESERVE sizeof(struct llc_pdu_un)
225*4882a593Smuzhiyun skb = alloc_skb(app->dev->mtu + LL_RESERVED_SPACE(app->dev),
226*4882a593Smuzhiyun GFP_ATOMIC);
227*4882a593Smuzhiyun if (!skb)
228*4882a593Smuzhiyun return -ENOMEM;
229*4882a593Smuzhiyun
230*4882a593Smuzhiyun skb->dev = app->dev;
231*4882a593Smuzhiyun skb->protocol = htons(ETH_P_802_2);
232*4882a593Smuzhiyun skb_reserve(skb, LL_RESERVED_SPACE(app->dev) + LLC_RESERVE);
233*4882a593Smuzhiyun
234*4882a593Smuzhiyun gp = __skb_put(skb, sizeof(*gp));
235*4882a593Smuzhiyun put_unaligned(htons(GARP_PROTOCOL_ID), &gp->protocol);
236*4882a593Smuzhiyun
237*4882a593Smuzhiyun app->pdu = skb;
238*4882a593Smuzhiyun return 0;
239*4882a593Smuzhiyun }
240*4882a593Smuzhiyun
garp_pdu_append_end_mark(struct garp_applicant * app)241*4882a593Smuzhiyun static int garp_pdu_append_end_mark(struct garp_applicant *app)
242*4882a593Smuzhiyun {
243*4882a593Smuzhiyun if (skb_tailroom(app->pdu) < sizeof(u8))
244*4882a593Smuzhiyun return -1;
245*4882a593Smuzhiyun __skb_put_u8(app->pdu, GARP_END_MARK);
246*4882a593Smuzhiyun return 0;
247*4882a593Smuzhiyun }
248*4882a593Smuzhiyun
garp_pdu_queue(struct garp_applicant * app)249*4882a593Smuzhiyun static void garp_pdu_queue(struct garp_applicant *app)
250*4882a593Smuzhiyun {
251*4882a593Smuzhiyun if (!app->pdu)
252*4882a593Smuzhiyun return;
253*4882a593Smuzhiyun
254*4882a593Smuzhiyun garp_pdu_append_end_mark(app);
255*4882a593Smuzhiyun garp_pdu_append_end_mark(app);
256*4882a593Smuzhiyun
257*4882a593Smuzhiyun llc_pdu_header_init(app->pdu, LLC_PDU_TYPE_U, LLC_SAP_BSPAN,
258*4882a593Smuzhiyun LLC_SAP_BSPAN, LLC_PDU_CMD);
259*4882a593Smuzhiyun llc_pdu_init_as_ui_cmd(app->pdu);
260*4882a593Smuzhiyun llc_mac_hdr_init(app->pdu, app->dev->dev_addr,
261*4882a593Smuzhiyun app->app->proto.group_address);
262*4882a593Smuzhiyun
263*4882a593Smuzhiyun skb_queue_tail(&app->queue, app->pdu);
264*4882a593Smuzhiyun app->pdu = NULL;
265*4882a593Smuzhiyun }
266*4882a593Smuzhiyun
garp_queue_xmit(struct garp_applicant * app)267*4882a593Smuzhiyun static void garp_queue_xmit(struct garp_applicant *app)
268*4882a593Smuzhiyun {
269*4882a593Smuzhiyun struct sk_buff *skb;
270*4882a593Smuzhiyun
271*4882a593Smuzhiyun while ((skb = skb_dequeue(&app->queue)))
272*4882a593Smuzhiyun dev_queue_xmit(skb);
273*4882a593Smuzhiyun }
274*4882a593Smuzhiyun
garp_pdu_append_msg(struct garp_applicant * app,u8 attrtype)275*4882a593Smuzhiyun static int garp_pdu_append_msg(struct garp_applicant *app, u8 attrtype)
276*4882a593Smuzhiyun {
277*4882a593Smuzhiyun struct garp_msg_hdr *gm;
278*4882a593Smuzhiyun
279*4882a593Smuzhiyun if (skb_tailroom(app->pdu) < sizeof(*gm))
280*4882a593Smuzhiyun return -1;
281*4882a593Smuzhiyun gm = __skb_put(app->pdu, sizeof(*gm));
282*4882a593Smuzhiyun gm->attrtype = attrtype;
283*4882a593Smuzhiyun garp_cb(app->pdu)->cur_type = attrtype;
284*4882a593Smuzhiyun return 0;
285*4882a593Smuzhiyun }
286*4882a593Smuzhiyun
garp_pdu_append_attr(struct garp_applicant * app,const struct garp_attr * attr,enum garp_attr_event event)287*4882a593Smuzhiyun static int garp_pdu_append_attr(struct garp_applicant *app,
288*4882a593Smuzhiyun const struct garp_attr *attr,
289*4882a593Smuzhiyun enum garp_attr_event event)
290*4882a593Smuzhiyun {
291*4882a593Smuzhiyun struct garp_attr_hdr *ga;
292*4882a593Smuzhiyun unsigned int len;
293*4882a593Smuzhiyun int err;
294*4882a593Smuzhiyun again:
295*4882a593Smuzhiyun if (!app->pdu) {
296*4882a593Smuzhiyun err = garp_pdu_init(app);
297*4882a593Smuzhiyun if (err < 0)
298*4882a593Smuzhiyun return err;
299*4882a593Smuzhiyun }
300*4882a593Smuzhiyun
301*4882a593Smuzhiyun if (garp_cb(app->pdu)->cur_type != attr->type) {
302*4882a593Smuzhiyun if (garp_cb(app->pdu)->cur_type &&
303*4882a593Smuzhiyun garp_pdu_append_end_mark(app) < 0)
304*4882a593Smuzhiyun goto queue;
305*4882a593Smuzhiyun if (garp_pdu_append_msg(app, attr->type) < 0)
306*4882a593Smuzhiyun goto queue;
307*4882a593Smuzhiyun }
308*4882a593Smuzhiyun
309*4882a593Smuzhiyun len = sizeof(*ga) + attr->dlen;
310*4882a593Smuzhiyun if (skb_tailroom(app->pdu) < len)
311*4882a593Smuzhiyun goto queue;
312*4882a593Smuzhiyun ga = __skb_put(app->pdu, len);
313*4882a593Smuzhiyun ga->len = len;
314*4882a593Smuzhiyun ga->event = event;
315*4882a593Smuzhiyun memcpy(ga->data, attr->data, attr->dlen);
316*4882a593Smuzhiyun return 0;
317*4882a593Smuzhiyun
318*4882a593Smuzhiyun queue:
319*4882a593Smuzhiyun garp_pdu_queue(app);
320*4882a593Smuzhiyun goto again;
321*4882a593Smuzhiyun }
322*4882a593Smuzhiyun
garp_attr_event(struct garp_applicant * app,struct garp_attr * attr,enum garp_event event)323*4882a593Smuzhiyun static void garp_attr_event(struct garp_applicant *app,
324*4882a593Smuzhiyun struct garp_attr *attr, enum garp_event event)
325*4882a593Smuzhiyun {
326*4882a593Smuzhiyun enum garp_applicant_state state;
327*4882a593Smuzhiyun
328*4882a593Smuzhiyun state = garp_applicant_state_table[attr->state][event].state;
329*4882a593Smuzhiyun if (state == GARP_APPLICANT_INVALID)
330*4882a593Smuzhiyun return;
331*4882a593Smuzhiyun
332*4882a593Smuzhiyun switch (garp_applicant_state_table[attr->state][event].action) {
333*4882a593Smuzhiyun case GARP_ACTION_NONE:
334*4882a593Smuzhiyun break;
335*4882a593Smuzhiyun case GARP_ACTION_S_JOIN_IN:
336*4882a593Smuzhiyun /* When appending the attribute fails, don't update state in
337*4882a593Smuzhiyun * order to retry on next TRANSMIT_PDU event. */
338*4882a593Smuzhiyun if (garp_pdu_append_attr(app, attr, GARP_JOIN_IN) < 0)
339*4882a593Smuzhiyun return;
340*4882a593Smuzhiyun break;
341*4882a593Smuzhiyun case GARP_ACTION_S_LEAVE_EMPTY:
342*4882a593Smuzhiyun garp_pdu_append_attr(app, attr, GARP_LEAVE_EMPTY);
343*4882a593Smuzhiyun /* As a pure applicant, sending a leave message implies that
344*4882a593Smuzhiyun * the attribute was unregistered and can be destroyed. */
345*4882a593Smuzhiyun garp_attr_destroy(app, attr);
346*4882a593Smuzhiyun return;
347*4882a593Smuzhiyun default:
348*4882a593Smuzhiyun WARN_ON(1);
349*4882a593Smuzhiyun }
350*4882a593Smuzhiyun
351*4882a593Smuzhiyun attr->state = state;
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun
garp_request_join(const struct net_device * dev,const struct garp_application * appl,const void * data,u8 len,u8 type)354*4882a593Smuzhiyun int garp_request_join(const struct net_device *dev,
355*4882a593Smuzhiyun const struct garp_application *appl,
356*4882a593Smuzhiyun const void *data, u8 len, u8 type)
357*4882a593Smuzhiyun {
358*4882a593Smuzhiyun struct garp_port *port = rtnl_dereference(dev->garp_port);
359*4882a593Smuzhiyun struct garp_applicant *app = rtnl_dereference(port->applicants[appl->type]);
360*4882a593Smuzhiyun struct garp_attr *attr;
361*4882a593Smuzhiyun
362*4882a593Smuzhiyun spin_lock_bh(&app->lock);
363*4882a593Smuzhiyun attr = garp_attr_create(app, data, len, type);
364*4882a593Smuzhiyun if (!attr) {
365*4882a593Smuzhiyun spin_unlock_bh(&app->lock);
366*4882a593Smuzhiyun return -ENOMEM;
367*4882a593Smuzhiyun }
368*4882a593Smuzhiyun garp_attr_event(app, attr, GARP_EVENT_REQ_JOIN);
369*4882a593Smuzhiyun spin_unlock_bh(&app->lock);
370*4882a593Smuzhiyun return 0;
371*4882a593Smuzhiyun }
372*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(garp_request_join);
373*4882a593Smuzhiyun
garp_request_leave(const struct net_device * dev,const struct garp_application * appl,const void * data,u8 len,u8 type)374*4882a593Smuzhiyun void garp_request_leave(const struct net_device *dev,
375*4882a593Smuzhiyun const struct garp_application *appl,
376*4882a593Smuzhiyun const void *data, u8 len, u8 type)
377*4882a593Smuzhiyun {
378*4882a593Smuzhiyun struct garp_port *port = rtnl_dereference(dev->garp_port);
379*4882a593Smuzhiyun struct garp_applicant *app = rtnl_dereference(port->applicants[appl->type]);
380*4882a593Smuzhiyun struct garp_attr *attr;
381*4882a593Smuzhiyun
382*4882a593Smuzhiyun spin_lock_bh(&app->lock);
383*4882a593Smuzhiyun attr = garp_attr_lookup(app, data, len, type);
384*4882a593Smuzhiyun if (!attr) {
385*4882a593Smuzhiyun spin_unlock_bh(&app->lock);
386*4882a593Smuzhiyun return;
387*4882a593Smuzhiyun }
388*4882a593Smuzhiyun garp_attr_event(app, attr, GARP_EVENT_REQ_LEAVE);
389*4882a593Smuzhiyun spin_unlock_bh(&app->lock);
390*4882a593Smuzhiyun }
391*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(garp_request_leave);
392*4882a593Smuzhiyun
garp_gid_event(struct garp_applicant * app,enum garp_event event)393*4882a593Smuzhiyun static void garp_gid_event(struct garp_applicant *app, enum garp_event event)
394*4882a593Smuzhiyun {
395*4882a593Smuzhiyun struct rb_node *node, *next;
396*4882a593Smuzhiyun struct garp_attr *attr;
397*4882a593Smuzhiyun
398*4882a593Smuzhiyun for (node = rb_first(&app->gid);
399*4882a593Smuzhiyun next = node ? rb_next(node) : NULL, node != NULL;
400*4882a593Smuzhiyun node = next) {
401*4882a593Smuzhiyun attr = rb_entry(node, struct garp_attr, node);
402*4882a593Smuzhiyun garp_attr_event(app, attr, event);
403*4882a593Smuzhiyun }
404*4882a593Smuzhiyun }
405*4882a593Smuzhiyun
garp_join_timer_arm(struct garp_applicant * app)406*4882a593Smuzhiyun static void garp_join_timer_arm(struct garp_applicant *app)
407*4882a593Smuzhiyun {
408*4882a593Smuzhiyun unsigned long delay;
409*4882a593Smuzhiyun
410*4882a593Smuzhiyun delay = (u64)msecs_to_jiffies(garp_join_time) * prandom_u32() >> 32;
411*4882a593Smuzhiyun mod_timer(&app->join_timer, jiffies + delay);
412*4882a593Smuzhiyun }
413*4882a593Smuzhiyun
garp_join_timer(struct timer_list * t)414*4882a593Smuzhiyun static void garp_join_timer(struct timer_list *t)
415*4882a593Smuzhiyun {
416*4882a593Smuzhiyun struct garp_applicant *app = from_timer(app, t, join_timer);
417*4882a593Smuzhiyun
418*4882a593Smuzhiyun spin_lock(&app->lock);
419*4882a593Smuzhiyun garp_gid_event(app, GARP_EVENT_TRANSMIT_PDU);
420*4882a593Smuzhiyun garp_pdu_queue(app);
421*4882a593Smuzhiyun spin_unlock(&app->lock);
422*4882a593Smuzhiyun
423*4882a593Smuzhiyun garp_queue_xmit(app);
424*4882a593Smuzhiyun garp_join_timer_arm(app);
425*4882a593Smuzhiyun }
426*4882a593Smuzhiyun
garp_pdu_parse_end_mark(struct sk_buff * skb)427*4882a593Smuzhiyun static int garp_pdu_parse_end_mark(struct sk_buff *skb)
428*4882a593Smuzhiyun {
429*4882a593Smuzhiyun if (!pskb_may_pull(skb, sizeof(u8)))
430*4882a593Smuzhiyun return -1;
431*4882a593Smuzhiyun if (*skb->data == GARP_END_MARK) {
432*4882a593Smuzhiyun skb_pull(skb, sizeof(u8));
433*4882a593Smuzhiyun return -1;
434*4882a593Smuzhiyun }
435*4882a593Smuzhiyun return 0;
436*4882a593Smuzhiyun }
437*4882a593Smuzhiyun
garp_pdu_parse_attr(struct garp_applicant * app,struct sk_buff * skb,u8 attrtype)438*4882a593Smuzhiyun static int garp_pdu_parse_attr(struct garp_applicant *app, struct sk_buff *skb,
439*4882a593Smuzhiyun u8 attrtype)
440*4882a593Smuzhiyun {
441*4882a593Smuzhiyun const struct garp_attr_hdr *ga;
442*4882a593Smuzhiyun struct garp_attr *attr;
443*4882a593Smuzhiyun enum garp_event event;
444*4882a593Smuzhiyun unsigned int dlen;
445*4882a593Smuzhiyun
446*4882a593Smuzhiyun if (!pskb_may_pull(skb, sizeof(*ga)))
447*4882a593Smuzhiyun return -1;
448*4882a593Smuzhiyun ga = (struct garp_attr_hdr *)skb->data;
449*4882a593Smuzhiyun if (ga->len < sizeof(*ga))
450*4882a593Smuzhiyun return -1;
451*4882a593Smuzhiyun
452*4882a593Smuzhiyun if (!pskb_may_pull(skb, ga->len))
453*4882a593Smuzhiyun return -1;
454*4882a593Smuzhiyun skb_pull(skb, ga->len);
455*4882a593Smuzhiyun dlen = sizeof(*ga) - ga->len;
456*4882a593Smuzhiyun
457*4882a593Smuzhiyun if (attrtype > app->app->maxattr)
458*4882a593Smuzhiyun return 0;
459*4882a593Smuzhiyun
460*4882a593Smuzhiyun switch (ga->event) {
461*4882a593Smuzhiyun case GARP_LEAVE_ALL:
462*4882a593Smuzhiyun if (dlen != 0)
463*4882a593Smuzhiyun return -1;
464*4882a593Smuzhiyun garp_gid_event(app, GARP_EVENT_R_LEAVE_EMPTY);
465*4882a593Smuzhiyun return 0;
466*4882a593Smuzhiyun case GARP_JOIN_EMPTY:
467*4882a593Smuzhiyun event = GARP_EVENT_R_JOIN_EMPTY;
468*4882a593Smuzhiyun break;
469*4882a593Smuzhiyun case GARP_JOIN_IN:
470*4882a593Smuzhiyun event = GARP_EVENT_R_JOIN_IN;
471*4882a593Smuzhiyun break;
472*4882a593Smuzhiyun case GARP_LEAVE_EMPTY:
473*4882a593Smuzhiyun event = GARP_EVENT_R_LEAVE_EMPTY;
474*4882a593Smuzhiyun break;
475*4882a593Smuzhiyun case GARP_EMPTY:
476*4882a593Smuzhiyun event = GARP_EVENT_R_EMPTY;
477*4882a593Smuzhiyun break;
478*4882a593Smuzhiyun default:
479*4882a593Smuzhiyun return 0;
480*4882a593Smuzhiyun }
481*4882a593Smuzhiyun
482*4882a593Smuzhiyun if (dlen == 0)
483*4882a593Smuzhiyun return -1;
484*4882a593Smuzhiyun attr = garp_attr_lookup(app, ga->data, dlen, attrtype);
485*4882a593Smuzhiyun if (attr == NULL)
486*4882a593Smuzhiyun return 0;
487*4882a593Smuzhiyun garp_attr_event(app, attr, event);
488*4882a593Smuzhiyun return 0;
489*4882a593Smuzhiyun }
490*4882a593Smuzhiyun
garp_pdu_parse_msg(struct garp_applicant * app,struct sk_buff * skb)491*4882a593Smuzhiyun static int garp_pdu_parse_msg(struct garp_applicant *app, struct sk_buff *skb)
492*4882a593Smuzhiyun {
493*4882a593Smuzhiyun const struct garp_msg_hdr *gm;
494*4882a593Smuzhiyun
495*4882a593Smuzhiyun if (!pskb_may_pull(skb, sizeof(*gm)))
496*4882a593Smuzhiyun return -1;
497*4882a593Smuzhiyun gm = (struct garp_msg_hdr *)skb->data;
498*4882a593Smuzhiyun if (gm->attrtype == 0)
499*4882a593Smuzhiyun return -1;
500*4882a593Smuzhiyun skb_pull(skb, sizeof(*gm));
501*4882a593Smuzhiyun
502*4882a593Smuzhiyun while (skb->len > 0) {
503*4882a593Smuzhiyun if (garp_pdu_parse_attr(app, skb, gm->attrtype) < 0)
504*4882a593Smuzhiyun return -1;
505*4882a593Smuzhiyun if (garp_pdu_parse_end_mark(skb) < 0)
506*4882a593Smuzhiyun break;
507*4882a593Smuzhiyun }
508*4882a593Smuzhiyun return 0;
509*4882a593Smuzhiyun }
510*4882a593Smuzhiyun
garp_pdu_rcv(const struct stp_proto * proto,struct sk_buff * skb,struct net_device * dev)511*4882a593Smuzhiyun static void garp_pdu_rcv(const struct stp_proto *proto, struct sk_buff *skb,
512*4882a593Smuzhiyun struct net_device *dev)
513*4882a593Smuzhiyun {
514*4882a593Smuzhiyun struct garp_application *appl = proto->data;
515*4882a593Smuzhiyun struct garp_port *port;
516*4882a593Smuzhiyun struct garp_applicant *app;
517*4882a593Smuzhiyun const struct garp_pdu_hdr *gp;
518*4882a593Smuzhiyun
519*4882a593Smuzhiyun port = rcu_dereference(dev->garp_port);
520*4882a593Smuzhiyun if (!port)
521*4882a593Smuzhiyun goto err;
522*4882a593Smuzhiyun app = rcu_dereference(port->applicants[appl->type]);
523*4882a593Smuzhiyun if (!app)
524*4882a593Smuzhiyun goto err;
525*4882a593Smuzhiyun
526*4882a593Smuzhiyun if (!pskb_may_pull(skb, sizeof(*gp)))
527*4882a593Smuzhiyun goto err;
528*4882a593Smuzhiyun gp = (struct garp_pdu_hdr *)skb->data;
529*4882a593Smuzhiyun if (get_unaligned(&gp->protocol) != htons(GARP_PROTOCOL_ID))
530*4882a593Smuzhiyun goto err;
531*4882a593Smuzhiyun skb_pull(skb, sizeof(*gp));
532*4882a593Smuzhiyun
533*4882a593Smuzhiyun spin_lock(&app->lock);
534*4882a593Smuzhiyun while (skb->len > 0) {
535*4882a593Smuzhiyun if (garp_pdu_parse_msg(app, skb) < 0)
536*4882a593Smuzhiyun break;
537*4882a593Smuzhiyun if (garp_pdu_parse_end_mark(skb) < 0)
538*4882a593Smuzhiyun break;
539*4882a593Smuzhiyun }
540*4882a593Smuzhiyun spin_unlock(&app->lock);
541*4882a593Smuzhiyun err:
542*4882a593Smuzhiyun kfree_skb(skb);
543*4882a593Smuzhiyun }
544*4882a593Smuzhiyun
garp_init_port(struct net_device * dev)545*4882a593Smuzhiyun static int garp_init_port(struct net_device *dev)
546*4882a593Smuzhiyun {
547*4882a593Smuzhiyun struct garp_port *port;
548*4882a593Smuzhiyun
549*4882a593Smuzhiyun port = kzalloc(sizeof(*port), GFP_KERNEL);
550*4882a593Smuzhiyun if (!port)
551*4882a593Smuzhiyun return -ENOMEM;
552*4882a593Smuzhiyun rcu_assign_pointer(dev->garp_port, port);
553*4882a593Smuzhiyun return 0;
554*4882a593Smuzhiyun }
555*4882a593Smuzhiyun
garp_release_port(struct net_device * dev)556*4882a593Smuzhiyun static void garp_release_port(struct net_device *dev)
557*4882a593Smuzhiyun {
558*4882a593Smuzhiyun struct garp_port *port = rtnl_dereference(dev->garp_port);
559*4882a593Smuzhiyun unsigned int i;
560*4882a593Smuzhiyun
561*4882a593Smuzhiyun for (i = 0; i <= GARP_APPLICATION_MAX; i++) {
562*4882a593Smuzhiyun if (rtnl_dereference(port->applicants[i]))
563*4882a593Smuzhiyun return;
564*4882a593Smuzhiyun }
565*4882a593Smuzhiyun RCU_INIT_POINTER(dev->garp_port, NULL);
566*4882a593Smuzhiyun kfree_rcu(port, rcu);
567*4882a593Smuzhiyun }
568*4882a593Smuzhiyun
garp_init_applicant(struct net_device * dev,struct garp_application * appl)569*4882a593Smuzhiyun int garp_init_applicant(struct net_device *dev, struct garp_application *appl)
570*4882a593Smuzhiyun {
571*4882a593Smuzhiyun struct garp_applicant *app;
572*4882a593Smuzhiyun int err;
573*4882a593Smuzhiyun
574*4882a593Smuzhiyun ASSERT_RTNL();
575*4882a593Smuzhiyun
576*4882a593Smuzhiyun if (!rtnl_dereference(dev->garp_port)) {
577*4882a593Smuzhiyun err = garp_init_port(dev);
578*4882a593Smuzhiyun if (err < 0)
579*4882a593Smuzhiyun goto err1;
580*4882a593Smuzhiyun }
581*4882a593Smuzhiyun
582*4882a593Smuzhiyun err = -ENOMEM;
583*4882a593Smuzhiyun app = kzalloc(sizeof(*app), GFP_KERNEL);
584*4882a593Smuzhiyun if (!app)
585*4882a593Smuzhiyun goto err2;
586*4882a593Smuzhiyun
587*4882a593Smuzhiyun err = dev_mc_add(dev, appl->proto.group_address);
588*4882a593Smuzhiyun if (err < 0)
589*4882a593Smuzhiyun goto err3;
590*4882a593Smuzhiyun
591*4882a593Smuzhiyun app->dev = dev;
592*4882a593Smuzhiyun app->app = appl;
593*4882a593Smuzhiyun app->gid = RB_ROOT;
594*4882a593Smuzhiyun spin_lock_init(&app->lock);
595*4882a593Smuzhiyun skb_queue_head_init(&app->queue);
596*4882a593Smuzhiyun rcu_assign_pointer(dev->garp_port->applicants[appl->type], app);
597*4882a593Smuzhiyun timer_setup(&app->join_timer, garp_join_timer, 0);
598*4882a593Smuzhiyun garp_join_timer_arm(app);
599*4882a593Smuzhiyun return 0;
600*4882a593Smuzhiyun
601*4882a593Smuzhiyun err3:
602*4882a593Smuzhiyun kfree(app);
603*4882a593Smuzhiyun err2:
604*4882a593Smuzhiyun garp_release_port(dev);
605*4882a593Smuzhiyun err1:
606*4882a593Smuzhiyun return err;
607*4882a593Smuzhiyun }
608*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(garp_init_applicant);
609*4882a593Smuzhiyun
garp_uninit_applicant(struct net_device * dev,struct garp_application * appl)610*4882a593Smuzhiyun void garp_uninit_applicant(struct net_device *dev, struct garp_application *appl)
611*4882a593Smuzhiyun {
612*4882a593Smuzhiyun struct garp_port *port = rtnl_dereference(dev->garp_port);
613*4882a593Smuzhiyun struct garp_applicant *app = rtnl_dereference(port->applicants[appl->type]);
614*4882a593Smuzhiyun
615*4882a593Smuzhiyun ASSERT_RTNL();
616*4882a593Smuzhiyun
617*4882a593Smuzhiyun RCU_INIT_POINTER(port->applicants[appl->type], NULL);
618*4882a593Smuzhiyun
619*4882a593Smuzhiyun /* Delete timer and generate a final TRANSMIT_PDU event to flush out
620*4882a593Smuzhiyun * all pending messages before the applicant is gone. */
621*4882a593Smuzhiyun del_timer_sync(&app->join_timer);
622*4882a593Smuzhiyun
623*4882a593Smuzhiyun spin_lock_bh(&app->lock);
624*4882a593Smuzhiyun garp_gid_event(app, GARP_EVENT_TRANSMIT_PDU);
625*4882a593Smuzhiyun garp_attr_destroy_all(app);
626*4882a593Smuzhiyun garp_pdu_queue(app);
627*4882a593Smuzhiyun spin_unlock_bh(&app->lock);
628*4882a593Smuzhiyun
629*4882a593Smuzhiyun garp_queue_xmit(app);
630*4882a593Smuzhiyun
631*4882a593Smuzhiyun dev_mc_del(dev, appl->proto.group_address);
632*4882a593Smuzhiyun kfree_rcu(app, rcu);
633*4882a593Smuzhiyun garp_release_port(dev);
634*4882a593Smuzhiyun }
635*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(garp_uninit_applicant);
636*4882a593Smuzhiyun
garp_register_application(struct garp_application * appl)637*4882a593Smuzhiyun int garp_register_application(struct garp_application *appl)
638*4882a593Smuzhiyun {
639*4882a593Smuzhiyun appl->proto.rcv = garp_pdu_rcv;
640*4882a593Smuzhiyun appl->proto.data = appl;
641*4882a593Smuzhiyun return stp_proto_register(&appl->proto);
642*4882a593Smuzhiyun }
643*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(garp_register_application);
644*4882a593Smuzhiyun
garp_unregister_application(struct garp_application * appl)645*4882a593Smuzhiyun void garp_unregister_application(struct garp_application *appl)
646*4882a593Smuzhiyun {
647*4882a593Smuzhiyun stp_proto_unregister(&appl->proto);
648*4882a593Smuzhiyun }
649*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(garp_unregister_application);
650