bbd8e254477ce6bff701d62e06fb654c51f838e0
[openwrt.git] / target / linux / generic / patches-4.1 / 645-bridge_multicast_to_unicast.patch
1 --- a/include/linux/if_bridge.h
2 +++ b/include/linux/if_bridge.h
3 @@ -46,6 +46,7 @@ struct br_ip_list {
4  #define BR_LEARNING_SYNC       BIT(9)
5  #define BR_PROXYARP_WIFI       BIT(10)
6  #define BR_ISOLATE_MODE        BIT(11)
7 +#define BR_MULTICAST_TO_UCAST  BIT(12)
8  
9  extern void brioctl_set(int (*ioctl_hook)(struct net *, unsigned int, void __user *));
10  
11 --- a/net/bridge/br_multicast.c
12 +++ b/net/bridge/br_multicast.c
13 @@ -635,7 +635,8 @@ struct net_bridge_port_group *br_multica
14                         struct net_bridge_port *port,
15                         struct br_ip *group,
16                         struct net_bridge_port_group __rcu *next,
17 -                       unsigned char state)
18 +                       unsigned char state,
19 +                       const unsigned char *src)
20  {
21         struct net_bridge_port_group *p;
22  
23 @@ -650,12 +651,33 @@ struct net_bridge_port_group *br_multica
24         hlist_add_head(&p->mglist, &port->mglist);
25         setup_timer(&p->timer, br_multicast_port_group_expired,
26                     (unsigned long)p);
27 +       if ((port->flags & BR_MULTICAST_TO_UCAST) && src) {
28 +               memcpy(p->eth_addr, src, ETH_ALEN);
29 +               p->unicast = true;
30 +       }
31         return p;
32  }
33  
34 +static bool br_port_group_equal(struct net_bridge_port_group *p,
35 +                               struct net_bridge_port *port,
36 +                               const unsigned char *src)
37 +{
38 +       if (p->port != port)
39 +               return false;
40 +
41 +       if (!p->unicast)
42 +               return true;
43 +
44 +       if (!src)
45 +               return false;
46 +
47 +       return ether_addr_equal(src, p->eth_addr);
48 +}
49 +
50  static int br_multicast_add_group(struct net_bridge *br,
51                                   struct net_bridge_port *port,
52 -                                 struct br_ip *group)
53 +                                 struct br_ip *group,
54 +                                 const unsigned char *src)
55  {
56         struct net_bridge_mdb_entry *mp;
57         struct net_bridge_port_group *p;
58 @@ -682,13 +704,13 @@ static int br_multicast_add_group(struct
59         for (pp = &mp->ports;
60              (p = mlock_dereference(*pp, br)) != NULL;
61              pp = &p->next) {
62 -               if (p->port == port)
63 +               if (br_port_group_equal(p, port, src))
64                         goto found;
65                 if ((unsigned long)p->port < (unsigned long)port)
66                         break;
67         }
68  
69 -       p = br_multicast_new_port_group(port, group, *pp, MDB_TEMPORARY);
70 +       p = br_multicast_new_port_group(port, group, *pp, MDB_TEMPORARY, src);
71         if (unlikely(!p))
72                 goto err;
73         rcu_assign_pointer(*pp, p);
74 @@ -707,7 +729,7 @@ err:
75  static int br_ip4_multicast_add_group(struct net_bridge *br,
76                                       struct net_bridge_port *port,
77                                       __be32 group,
78 -                                     __u16 vid)
79 +                                     __u16 vid, const unsigned char *src)
80  {
81         struct br_ip br_group;
82  
83 @@ -718,14 +740,14 @@ static int br_ip4_multicast_add_group(st
84         br_group.proto = htons(ETH_P_IP);
85         br_group.vid = vid;
86  
87 -       return br_multicast_add_group(br, port, &br_group);
88 +       return br_multicast_add_group(br, port, &br_group, src);
89  }
90  
91  #if IS_ENABLED(CONFIG_IPV6)
92  static int br_ip6_multicast_add_group(struct net_bridge *br,
93                                       struct net_bridge_port *port,
94                                       const struct in6_addr *group,
95 -                                     __u16 vid)
96 +                                     __u16 vid, const unsigned char *src)
97  {
98         struct br_ip br_group;
99  
100 @@ -736,7 +758,7 @@ static int br_ip6_multicast_add_group(st
101         br_group.proto = htons(ETH_P_IPV6);
102         br_group.vid = vid;
103  
104 -       return br_multicast_add_group(br, port, &br_group);
105 +       return br_multicast_add_group(br, port, &br_group, src);
106  }
107  #endif
108  
109 @@ -966,6 +988,7 @@ static int br_ip4_multicast_igmp3_report
110                                          struct sk_buff *skb,
111                                          u16 vid)
112  {
113 +       const unsigned char *src;
114         struct igmpv3_report *ih;
115         struct igmpv3_grec *grec;
116         int i;
117 @@ -1009,7 +1032,8 @@ static int br_ip4_multicast_igmp3_report
118                         continue;
119                 }
120  
121 -               err = br_ip4_multicast_add_group(br, port, group, vid);
122 +               src = eth_hdr(skb)->h_source;
123 +               err = br_ip4_multicast_add_group(br, port, group, vid, src);
124                 if (err)
125                         break;
126         }
127 @@ -1023,6 +1047,7 @@ static int br_ip6_multicast_mld2_report(
128                                         struct sk_buff *skb,
129                                         u16 vid)
130  {
131 +       const unsigned char *src = eth_hdr(skb)->h_source;
132         struct icmp6hdr *icmp6h;
133         struct mld2_grec *grec;
134         int i;
135 @@ -1071,7 +1096,7 @@ static int br_ip6_multicast_mld2_report(
136                 }
137  
138                 err = br_ip6_multicast_add_group(br, port, &grec->grec_mca,
139 -                                                vid);
140 +                                                vid, src);
141                 if (err)
142                         break;
143         }
144 @@ -1407,7 +1432,8 @@ br_multicast_leave_group(struct net_brid
145                          struct net_bridge_port *port,
146                          struct br_ip *group,
147                          struct bridge_mcast_other_query *other_query,
148 -                        struct bridge_mcast_own_query *own_query)
149 +                        struct bridge_mcast_own_query *own_query,
150 +                        const unsigned char *src)
151  {
152         struct net_bridge_mdb_htable *mdb;
153         struct net_bridge_mdb_entry *mp;
154 @@ -1457,7 +1483,7 @@ br_multicast_leave_group(struct net_brid
155                 for (pp = &mp->ports;
156                      (p = mlock_dereference(*pp, br)) != NULL;
157                      pp = &p->next) {
158 -                       if (p->port != port)
159 +                       if (!br_port_group_equal(p, port, src))
160                                 continue;
161  
162                         rcu_assign_pointer(*pp, p->next);
163 @@ -1491,7 +1517,7 @@ br_multicast_leave_group(struct net_brid
164         for (p = mlock_dereference(mp->ports, br);
165              p != NULL;
166              p = mlock_dereference(p->next, br)) {
167 -               if (p->port != port)
168 +               if (!br_port_group_equal(p, port, src))
169                         continue;
170  
171                 if (!hlist_unhashed(&p->mglist) &&
172 @@ -1509,8 +1535,8 @@ out:
173  
174  static void br_ip4_multicast_leave_group(struct net_bridge *br,
175                                          struct net_bridge_port *port,
176 -                                        __be32 group,
177 -                                        __u16 vid)
178 +                                        __be32 group, __u16 vid,
179 +                                        const unsigned char *src)
180  {
181         struct br_ip br_group;
182         struct bridge_mcast_own_query *own_query;
183 @@ -1525,14 +1551,14 @@ static void br_ip4_multicast_leave_group
184         br_group.vid = vid;
185  
186         br_multicast_leave_group(br, port, &br_group, &br->ip4_other_query,
187 -                                own_query);
188 +                                own_query, src);
189  }
190  
191  #if IS_ENABLED(CONFIG_IPV6)
192  static void br_ip6_multicast_leave_group(struct net_bridge *br,
193                                          struct net_bridge_port *port,
194                                          const struct in6_addr *group,
195 -                                        __u16 vid)
196 +                                        __u16 vid, const unsigned char *src)
197  {
198         struct br_ip br_group;
199         struct bridge_mcast_own_query *own_query;
200 @@ -1547,7 +1573,7 @@ static void br_ip6_multicast_leave_group
201         br_group.vid = vid;
202  
203         br_multicast_leave_group(br, port, &br_group, &br->ip6_other_query,
204 -                                own_query);
205 +                                own_query, src);
206  }
207  #endif
208  
209 @@ -1556,6 +1582,7 @@ static int br_multicast_ipv4_rcv(struct
210                                  struct sk_buff *skb,
211                                  u16 vid)
212  {
213 +       const unsigned char *src;
214         struct sk_buff *skb2 = skb;
215         const struct iphdr *iph;
216         struct igmphdr *ih;
217 @@ -1624,12 +1651,13 @@ static int br_multicast_ipv4_rcv(struct
218  
219         BR_INPUT_SKB_CB(skb)->igmp = 1;
220         ih = igmp_hdr(skb2);
221 +       src = eth_hdr(skb)->h_source;
222  
223         switch (ih->type) {
224         case IGMP_HOST_MEMBERSHIP_REPORT:
225         case IGMPV2_HOST_MEMBERSHIP_REPORT:
226                 BR_INPUT_SKB_CB(skb)->mrouters_only = 1;
227 -               err = br_ip4_multicast_add_group(br, port, ih->group, vid);
228 +               err = br_ip4_multicast_add_group(br, port, ih->group, vid, src);
229                 break;
230         case IGMPV3_HOST_MEMBERSHIP_REPORT:
231                 err = br_ip4_multicast_igmp3_report(br, port, skb2, vid);
232 @@ -1638,7 +1666,7 @@ static int br_multicast_ipv4_rcv(struct
233                 err = br_ip4_multicast_query(br, port, skb2, vid);
234                 break;
235         case IGMP_HOST_LEAVE_MESSAGE:
236 -               br_ip4_multicast_leave_group(br, port, ih->group, vid);
237 +               br_ip4_multicast_leave_group(br, port, ih->group, vid, src);
238                 break;
239         }
240  
241 @@ -1656,6 +1684,7 @@ static int br_multicast_ipv6_rcv(struct
242                                  struct sk_buff *skb,
243                                  u16 vid)
244  {
245 +       const unsigned char *src;
246         struct sk_buff *skb2;
247         const struct ipv6hdr *ip6h;
248         u8 icmp6_type;
249 @@ -1763,9 +1792,11 @@ static int br_multicast_ipv6_rcv(struct
250                         err = -EINVAL;
251                         goto out;
252                 }
253 +               src = eth_hdr(skb)->h_source;
254                 mld = (struct mld_msg *)skb_transport_header(skb2);
255                 BR_INPUT_SKB_CB(skb)->mrouters_only = 1;
256 -               err = br_ip6_multicast_add_group(br, port, &mld->mld_mca, vid);
257 +               err = br_ip6_multicast_add_group(br, port, &mld->mld_mca, vid,
258 +                                                src);
259                 break;
260             }
261         case ICMPV6_MLD2_REPORT:
262 @@ -1781,8 +1812,9 @@ static int br_multicast_ipv6_rcv(struct
263                         err = -EINVAL;
264                         goto out;
265                 }
266 +               src = eth_hdr(skb)->h_source;
267                 mld = (struct mld_msg *)skb_transport_header(skb2);
268 -               br_ip6_multicast_leave_group(br, port, &mld->mld_mca, vid);
269 +               br_ip6_multicast_leave_group(br, port, &mld->mld_mca, vid, src);
270             }
271         }
272  
273 --- a/net/bridge/br_private.h
274 +++ b/net/bridge/br_private.h
275 @@ -113,6 +113,9 @@ struct net_bridge_port_group {
276         struct timer_list               timer;
277         struct br_ip                    addr;
278         unsigned char                   state;
279 +
280 +       unsigned char                   eth_addr[ETH_ALEN];
281 +       bool                            unicast;
282  };
283  
284  struct net_bridge_mdb_entry
285 @@ -481,7 +484,8 @@ void br_multicast_free_pg(struct rcu_hea
286  struct net_bridge_port_group *
287  br_multicast_new_port_group(struct net_bridge_port *port, struct br_ip *group,
288                             struct net_bridge_port_group __rcu *next,
289 -                           unsigned char state);
290 +                           unsigned char state,
291 +                      const unsigned char *src);
292  void br_mdb_init(void);
293  void br_mdb_uninit(void);
294  void br_mdb_notify(struct net_device *dev, struct net_bridge_port *port,
295 --- a/net/bridge/br_mdb.c
296 +++ b/net/bridge/br_mdb.c
297 @@ -343,7 +343,7 @@ static int br_mdb_add_group(struct net_b
298                         break;
299         }
300  
301 -       p = br_multicast_new_port_group(port, group, *pp, state);
302 +       p = br_multicast_new_port_group(port, group, *pp, state, NULL);
303         if (unlikely(!p))
304                 return -ENOMEM;
305         rcu_assign_pointer(*pp, p);
306 --- a/net/bridge/br_forward.c
307 +++ b/net/bridge/br_forward.c
308 @@ -169,6 +169,34 @@ out:
309         return p;
310  }
311  
312 +static struct net_bridge_port *maybe_deliver_addr(
313 +       struct net_bridge_port *prev, struct net_bridge_port *p,
314 +       struct sk_buff *skb, const unsigned char *addr,
315 +       void (*__packet_hook)(const struct net_bridge_port *p,
316 +                             struct sk_buff *skb))
317 +{
318 +       struct net_device *dev = BR_INPUT_SKB_CB(skb)->brdev;
319 +       const unsigned char *src = eth_hdr(skb)->h_source;
320 +
321 +       if (!should_deliver(p, skb))
322 +               return prev;
323 +
324 +       /* Even with hairpin, no soliloquies - prevent breaking IPv6 DAD */
325 +       if (skb->dev == p->dev && ether_addr_equal(src, addr))
326 +               return prev;
327 +
328 +       skb = skb_copy(skb, GFP_ATOMIC);
329 +       if (!skb) {
330 +               dev->stats.tx_dropped++;
331 +               return prev;
332 +       }
333 +
334 +       memcpy(eth_hdr(skb)->h_dest, addr, ETH_ALEN);
335 +       __packet_hook(p, skb);
336 +
337 +       return prev;
338 +}
339 +
340  /* called under bridge lock */
341  static void br_flood(struct net_bridge *br, struct sk_buff *skb,
342                      struct sk_buff *skb0,
343 @@ -241,6 +269,7 @@ static void br_multicast_flood(struct ne
344         struct net_bridge_port *prev = NULL;
345         struct net_bridge_port_group *p;
346         struct hlist_node *rp;
347 +       const unsigned char *addr;
348  
349         rp = rcu_dereference(hlist_first_rcu(&br->router_list));
350         p = mdst ? rcu_dereference(mdst->ports) : NULL;
351 @@ -251,10 +280,19 @@ static void br_multicast_flood(struct ne
352                 rport = rp ? hlist_entry(rp, struct net_bridge_port, rlist) :
353                              NULL;
354  
355 -               port = (unsigned long)lport > (unsigned long)rport ?
356 -                      lport : rport;
357 -
358 -               prev = maybe_deliver(prev, port, skb, __packet_hook);
359 +               if ((unsigned long)lport > (unsigned long)rport) {
360 +                       port = lport;
361 +                       addr = p->unicast ? p->eth_addr : NULL;
362 +               } else {
363 +                       port = rport;
364 +                       addr = NULL;
365 +               }
366 +
367 +               if (addr)
368 +                       prev = maybe_deliver_addr(prev, port, skb, addr,
369 +                                                 __packet_hook);
370 +               else
371 +                       prev = maybe_deliver(prev, port, skb, __packet_hook);
372                 if (IS_ERR(prev))
373                         goto out;
374  
375 --- a/net/bridge/br_sysfs_if.c
376 +++ b/net/bridge/br_sysfs_if.c
377 @@ -204,6 +204,7 @@ static BRPORT_ATTR(multicast_router, S_I
378                    store_multicast_router);
379  
380  BRPORT_ATTR_FLAG(multicast_fast_leave, BR_MULTICAST_FAST_LEAVE);
381 +BRPORT_ATTR_FLAG(multicast_to_unicast, BR_MULTICAST_TO_UCAST);
382  #endif
383  
384  static const struct brport_attribute *brport_attrs[] = {
385 @@ -230,6 +231,7 @@ static const struct brport_attribute *br
386  #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
387         &brport_attr_multicast_router,
388         &brport_attr_multicast_fast_leave,
389 +       &brport_attr_multicast_to_unicast,
390  #endif
391         &brport_attr_proxyarp,
392         &brport_attr_proxyarp_wifi,