~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/net/dsa/dsa.c

Version: ~ [ linux-4.20-rc6 ] ~ [ linux-4.19.8 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.87 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.144 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.166 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.19.8 ] ~ [ linux-3.18.128 ] ~ [ linux-3.17.8 ] ~ [ linux-3.16.61 ] ~ [ linux-3.15.10 ] ~ [ linux-3.14.79 ] ~ [ linux-3.13.11 ] ~ [ linux-3.12.74 ] ~ [ linux-3.11.10 ] ~ [ linux-3.10.108 ] ~ [ linux-3.9.11 ] ~ [ linux-3.8.13 ] ~ [ linux-3.7.10 ] ~ [ linux-3.6.11 ] ~ [ linux-3.5.7 ] ~ [ linux-3.4.113 ] ~ [ linux-3.3.8 ] ~ [ linux-3.2.102 ] ~ [ linux-3.1.10 ] ~ [ linux-3.0.101 ] ~ [ linux-2.6.39.4 ] ~ [ linux-2.6.38.8 ] ~ [ linux-2.6.37.6 ] ~ [ linux-2.6.36.4 ] ~ [ linux-2.6.35.14 ] ~ [ linux-2.6.34.15 ] ~ [ linux-2.6.33.20 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.31.14 ] ~ [ linux-2.6.30.10 ] ~ [ linux-2.6.29.6 ] ~ [ linux-2.6.28.10 ] ~ [ linux-2.6.27.62 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  1 /*
  2  * net/dsa/dsa.c - Hardware switch handling
  3  * Copyright (c) 2008-2009 Marvell Semiconductor
  4  * Copyright (c) 2013 Florian Fainelli <florian@openwrt.org>
  5  *
  6  * This program is free software; you can redistribute it and/or modify
  7  * it under the terms of the GNU General Public License as published by
  8  * the Free Software Foundation; either version 2 of the License, or
  9  * (at your option) any later version.
 10  */
 11 
 12 #include <linux/device.h>
 13 #include <linux/list.h>
 14 #include <linux/platform_device.h>
 15 #include <linux/slab.h>
 16 #include <linux/module.h>
 17 #include <linux/notifier.h>
 18 #include <linux/of.h>
 19 #include <linux/of_mdio.h>
 20 #include <linux/of_platform.h>
 21 #include <linux/of_net.h>
 22 #include <linux/netdevice.h>
 23 #include <linux/sysfs.h>
 24 #include <linux/phy_fixed.h>
 25 #include <linux/ptp_classify.h>
 26 #include <linux/etherdevice.h>
 27 
 28 #include "dsa_priv.h"
 29 
 30 static struct sk_buff *dsa_slave_notag_xmit(struct sk_buff *skb,
 31                                             struct net_device *dev)
 32 {
 33         /* Just return the original SKB */
 34         return skb;
 35 }
 36 
 37 static const struct dsa_device_ops none_ops = {
 38         .xmit   = dsa_slave_notag_xmit,
 39         .rcv    = NULL,
 40 };
 41 
 42 const struct dsa_device_ops *dsa_device_ops[DSA_TAG_LAST] = {
 43 #ifdef CONFIG_NET_DSA_TAG_BRCM
 44         [DSA_TAG_PROTO_BRCM] = &brcm_netdev_ops,
 45 #endif
 46 #ifdef CONFIG_NET_DSA_TAG_BRCM_PREPEND
 47         [DSA_TAG_PROTO_BRCM_PREPEND] = &brcm_prepend_netdev_ops,
 48 #endif
 49 #ifdef CONFIG_NET_DSA_TAG_DSA
 50         [DSA_TAG_PROTO_DSA] = &dsa_netdev_ops,
 51 #endif
 52 #ifdef CONFIG_NET_DSA_TAG_EDSA
 53         [DSA_TAG_PROTO_EDSA] = &edsa_netdev_ops,
 54 #endif
 55 #ifdef CONFIG_NET_DSA_TAG_GSWIP
 56         [DSA_TAG_PROTO_GSWIP] = &gswip_netdev_ops,
 57 #endif
 58 #ifdef CONFIG_NET_DSA_TAG_KSZ
 59         [DSA_TAG_PROTO_KSZ] = &ksz_netdev_ops,
 60 #endif
 61 #ifdef CONFIG_NET_DSA_TAG_LAN9303
 62         [DSA_TAG_PROTO_LAN9303] = &lan9303_netdev_ops,
 63 #endif
 64 #ifdef CONFIG_NET_DSA_TAG_MTK
 65         [DSA_TAG_PROTO_MTK] = &mtk_netdev_ops,
 66 #endif
 67 #ifdef CONFIG_NET_DSA_TAG_QCA
 68         [DSA_TAG_PROTO_QCA] = &qca_netdev_ops,
 69 #endif
 70 #ifdef CONFIG_NET_DSA_TAG_TRAILER
 71         [DSA_TAG_PROTO_TRAILER] = &trailer_netdev_ops,
 72 #endif
 73         [DSA_TAG_PROTO_NONE] = &none_ops,
 74 };
 75 
 76 const char *dsa_tag_protocol_to_str(const struct dsa_device_ops *ops)
 77 {
 78         const char *protocol_name[DSA_TAG_LAST] = {
 79 #ifdef CONFIG_NET_DSA_TAG_BRCM
 80                 [DSA_TAG_PROTO_BRCM] = "brcm",
 81 #endif
 82 #ifdef CONFIG_NET_DSA_TAG_BRCM_PREPEND
 83                 [DSA_TAG_PROTO_BRCM_PREPEND] = "brcm-prepend",
 84 #endif
 85 #ifdef CONFIG_NET_DSA_TAG_DSA
 86                 [DSA_TAG_PROTO_DSA] = "dsa",
 87 #endif
 88 #ifdef CONFIG_NET_DSA_TAG_EDSA
 89                 [DSA_TAG_PROTO_EDSA] = "edsa",
 90 #endif
 91 #ifdef CONFIG_NET_DSA_TAG_GSWIP
 92                 [DSA_TAG_PROTO_GSWIP] = "gswip",
 93 #endif
 94 #ifdef CONFIG_NET_DSA_TAG_KSZ
 95                 [DSA_TAG_PROTO_KSZ] = "ksz",
 96 #endif
 97 #ifdef CONFIG_NET_DSA_TAG_LAN9303
 98                 [DSA_TAG_PROTO_LAN9303] = "lan9303",
 99 #endif
100 #ifdef CONFIG_NET_DSA_TAG_MTK
101                 [DSA_TAG_PROTO_MTK] = "mtk",
102 #endif
103 #ifdef CONFIG_NET_DSA_TAG_QCA
104                 [DSA_TAG_PROTO_QCA] = "qca",
105 #endif
106 #ifdef CONFIG_NET_DSA_TAG_TRAILER
107                 [DSA_TAG_PROTO_TRAILER] = "trailer",
108 #endif
109                 [DSA_TAG_PROTO_NONE] = "none",
110         };
111         unsigned int i;
112 
113         BUILD_BUG_ON(ARRAY_SIZE(protocol_name) != DSA_TAG_LAST);
114 
115         for (i = 0; i < ARRAY_SIZE(dsa_device_ops); i++)
116                 if (ops == dsa_device_ops[i])
117                         return protocol_name[i];
118 
119         return protocol_name[DSA_TAG_PROTO_NONE];
120 };
121 
122 const struct dsa_device_ops *dsa_resolve_tag_protocol(int tag_protocol)
123 {
124         const struct dsa_device_ops *ops;
125 
126         if (tag_protocol >= DSA_TAG_LAST)
127                 return ERR_PTR(-EINVAL);
128         ops = dsa_device_ops[tag_protocol];
129 
130         if (!ops)
131                 return ERR_PTR(-ENOPROTOOPT);
132 
133         return ops;
134 }
135 
136 static int dev_is_class(struct device *dev, void *class)
137 {
138         if (dev->class != NULL && !strcmp(dev->class->name, class))
139                 return 1;
140 
141         return 0;
142 }
143 
144 static struct device *dev_find_class(struct device *parent, char *class)
145 {
146         if (dev_is_class(parent, class)) {
147                 get_device(parent);
148                 return parent;
149         }
150 
151         return device_find_child(parent, class, dev_is_class);
152 }
153 
154 struct net_device *dsa_dev_to_net_device(struct device *dev)
155 {
156         struct device *d;
157 
158         d = dev_find_class(dev, "net");
159         if (d != NULL) {
160                 struct net_device *nd;
161 
162                 nd = to_net_dev(d);
163                 dev_hold(nd);
164                 put_device(d);
165 
166                 return nd;
167         }
168 
169         return NULL;
170 }
171 EXPORT_SYMBOL_GPL(dsa_dev_to_net_device);
172 
173 /* Determine if we should defer delivery of skb until we have a rx timestamp.
174  *
175  * Called from dsa_switch_rcv. For now, this will only work if tagging is
176  * enabled on the switch. Normally the MAC driver would retrieve the hardware
177  * timestamp when it reads the packet out of the hardware. However in a DSA
178  * switch, the DSA driver owning the interface to which the packet is
179  * delivered is never notified unless we do so here.
180  */
181 static bool dsa_skb_defer_rx_timestamp(struct dsa_slave_priv *p,
182                                        struct sk_buff *skb)
183 {
184         struct dsa_switch *ds = p->dp->ds;
185         unsigned int type;
186 
187         if (skb_headroom(skb) < ETH_HLEN)
188                 return false;
189 
190         __skb_push(skb, ETH_HLEN);
191 
192         type = ptp_classify_raw(skb);
193 
194         __skb_pull(skb, ETH_HLEN);
195 
196         if (type == PTP_CLASS_NONE)
197                 return false;
198 
199         if (likely(ds->ops->port_rxtstamp))
200                 return ds->ops->port_rxtstamp(ds, p->dp->index, skb, type);
201 
202         return false;
203 }
204 
205 static int dsa_switch_rcv(struct sk_buff *skb, struct net_device *dev,
206                           struct packet_type *pt, struct net_device *unused)
207 {
208         struct dsa_port *cpu_dp = dev->dsa_ptr;
209         struct sk_buff *nskb = NULL;
210         struct pcpu_sw_netstats *s;
211         struct dsa_slave_priv *p;
212 
213         if (unlikely(!cpu_dp)) {
214                 kfree_skb(skb);
215                 return 0;
216         }
217 
218         skb = skb_unshare(skb, GFP_ATOMIC);
219         if (!skb)
220                 return 0;
221 
222         nskb = cpu_dp->rcv(skb, dev, pt);
223         if (!nskb) {
224                 kfree_skb(skb);
225                 return 0;
226         }
227 
228         skb = nskb;
229         p = netdev_priv(skb->dev);
230         skb_push(skb, ETH_HLEN);
231         skb->pkt_type = PACKET_HOST;
232         skb->protocol = eth_type_trans(skb, skb->dev);
233 
234         s = this_cpu_ptr(p->stats64);
235         u64_stats_update_begin(&s->syncp);
236         s->rx_packets++;
237         s->rx_bytes += skb->len;
238         u64_stats_update_end(&s->syncp);
239 
240         if (dsa_skb_defer_rx_timestamp(p, skb))
241                 return 0;
242 
243         netif_receive_skb(skb);
244 
245         return 0;
246 }
247 
248 #ifdef CONFIG_PM_SLEEP
249 static bool dsa_is_port_initialized(struct dsa_switch *ds, int p)
250 {
251         return dsa_is_user_port(ds, p) && ds->ports[p].slave;
252 }
253 
254 int dsa_switch_suspend(struct dsa_switch *ds)
255 {
256         int i, ret = 0;
257 
258         /* Suspend slave network devices */
259         for (i = 0; i < ds->num_ports; i++) {
260                 if (!dsa_is_port_initialized(ds, i))
261                         continue;
262 
263                 ret = dsa_slave_suspend(ds->ports[i].slave);
264                 if (ret)
265                         return ret;
266         }
267 
268         if (ds->ops->suspend)
269                 ret = ds->ops->suspend(ds);
270 
271         return ret;
272 }
273 EXPORT_SYMBOL_GPL(dsa_switch_suspend);
274 
275 int dsa_switch_resume(struct dsa_switch *ds)
276 {
277         int i, ret = 0;
278 
279         if (ds->ops->resume)
280                 ret = ds->ops->resume(ds);
281 
282         if (ret)
283                 return ret;
284 
285         /* Resume slave network devices */
286         for (i = 0; i < ds->num_ports; i++) {
287                 if (!dsa_is_port_initialized(ds, i))
288                         continue;
289 
290                 ret = dsa_slave_resume(ds->ports[i].slave);
291                 if (ret)
292                         return ret;
293         }
294 
295         return 0;
296 }
297 EXPORT_SYMBOL_GPL(dsa_switch_resume);
298 #endif
299 
300 static struct packet_type dsa_pack_type __read_mostly = {
301         .type   = cpu_to_be16(ETH_P_XDSA),
302         .func   = dsa_switch_rcv,
303 };
304 
305 static struct workqueue_struct *dsa_owq;
306 
307 bool dsa_schedule_work(struct work_struct *work)
308 {
309         return queue_work(dsa_owq, work);
310 }
311 
312 static ATOMIC_NOTIFIER_HEAD(dsa_notif_chain);
313 
314 int register_dsa_notifier(struct notifier_block *nb)
315 {
316         return atomic_notifier_chain_register(&dsa_notif_chain, nb);
317 }
318 EXPORT_SYMBOL_GPL(register_dsa_notifier);
319 
320 int unregister_dsa_notifier(struct notifier_block *nb)
321 {
322         return atomic_notifier_chain_unregister(&dsa_notif_chain, nb);
323 }
324 EXPORT_SYMBOL_GPL(unregister_dsa_notifier);
325 
326 int call_dsa_notifiers(unsigned long val, struct net_device *dev,
327                        struct dsa_notifier_info *info)
328 {
329         info->dev = dev;
330         return atomic_notifier_call_chain(&dsa_notif_chain, val, info);
331 }
332 EXPORT_SYMBOL_GPL(call_dsa_notifiers);
333 
334 static int __init dsa_init_module(void)
335 {
336         int rc;
337 
338         dsa_owq = alloc_ordered_workqueue("dsa_ordered",
339                                           WQ_MEM_RECLAIM);
340         if (!dsa_owq)
341                 return -ENOMEM;
342 
343         rc = dsa_slave_register_notifier();
344         if (rc)
345                 return rc;
346 
347         rc = dsa_legacy_register();
348         if (rc)
349                 return rc;
350 
351         dev_add_pack(&dsa_pack_type);
352 
353         return 0;
354 }
355 module_init(dsa_init_module);
356 
357 static void __exit dsa_cleanup_module(void)
358 {
359         dsa_slave_unregister_notifier();
360         dev_remove_pack(&dsa_pack_type);
361         dsa_legacy_unregister();
362         destroy_workqueue(dsa_owq);
363 }
364 module_exit(dsa_cleanup_module);
365 
366 MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
367 MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
368 MODULE_LICENSE("GPL");
369 MODULE_ALIAS("platform:dsa");
370 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp