2 * net/dsa/dsa.c - Hardware switch handling
3 * Copyright (c) 2008-2009 Marvell Semiconductor
4 * Copyright (c) 2013 Florian Fainelli <florian@openwrt.org>
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.
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>
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>
30 static struct sk_buff *dsa_slave_notag_xmit(struct sk_buff *skb,
31 struct net_device *dev)
33 /* Just return the original SKB */
37 static const struct dsa_device_ops none_ops = {
38 .xmit = dsa_slave_notag_xmit,
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,
46 #ifdef CONFIG_NET_DSA_TAG_BRCM_PREPEND
47 [DSA_TAG_PROTO_BRCM_PREPEND] = &brcm_prepend_netdev_ops,
49 #ifdef CONFIG_NET_DSA_TAG_DSA
50 [DSA_TAG_PROTO_DSA] = &dsa_netdev_ops,
52 #ifdef CONFIG_NET_DSA_TAG_EDSA
53 [DSA_TAG_PROTO_EDSA] = &edsa_netdev_ops,
55 #ifdef CONFIG_NET_DSA_TAG_KSZ
56 [DSA_TAG_PROTO_KSZ] = &ksz_netdev_ops,
58 #ifdef CONFIG_NET_DSA_TAG_LAN9303
59 [DSA_TAG_PROTO_LAN9303] = &lan9303_netdev_ops,
61 #ifdef CONFIG_NET_DSA_TAG_MTK
62 [DSA_TAG_PROTO_MTK] = &mtk_netdev_ops,
64 #ifdef CONFIG_NET_DSA_TAG_QCA
65 [DSA_TAG_PROTO_QCA] = &qca_netdev_ops,
67 #ifdef CONFIG_NET_DSA_TAG_TRAILER
68 [DSA_TAG_PROTO_TRAILER] = &trailer_netdev_ops,
70 [DSA_TAG_PROTO_NONE] = &none_ops,
73 const struct dsa_device_ops *dsa_resolve_tag_protocol(int tag_protocol)
75 const struct dsa_device_ops *ops;
77 if (tag_protocol >= DSA_TAG_LAST)
78 return ERR_PTR(-EINVAL);
79 ops = dsa_device_ops[tag_protocol];
82 return ERR_PTR(-ENOPROTOOPT);
87 static int dev_is_class(struct device *dev, void *class)
89 if (dev->class != NULL && !strcmp(dev->class->name, class))
95 static struct device *dev_find_class(struct device *parent, char *class)
97 if (dev_is_class(parent, class)) {
102 return device_find_child(parent, class, dev_is_class);
105 struct net_device *dsa_dev_to_net_device(struct device *dev)
109 d = dev_find_class(dev, "net");
111 struct net_device *nd;
122 EXPORT_SYMBOL_GPL(dsa_dev_to_net_device);
124 /* Determine if we should defer delivery of skb until we have a rx timestamp.
126 * Called from dsa_switch_rcv. For now, this will only work if tagging is
127 * enabled on the switch. Normally the MAC driver would retrieve the hardware
128 * timestamp when it reads the packet out of the hardware. However in a DSA
129 * switch, the DSA driver owning the interface to which the packet is
130 * delivered is never notified unless we do so here.
132 static bool dsa_skb_defer_rx_timestamp(struct dsa_slave_priv *p,
135 struct dsa_switch *ds = p->dp->ds;
138 if (skb_headroom(skb) < ETH_HLEN)
141 __skb_push(skb, ETH_HLEN);
143 type = ptp_classify_raw(skb);
145 __skb_pull(skb, ETH_HLEN);
147 if (type == PTP_CLASS_NONE)
150 if (likely(ds->ops->port_rxtstamp))
151 return ds->ops->port_rxtstamp(ds, p->dp->index, skb, type);
156 static int dsa_switch_rcv(struct sk_buff *skb, struct net_device *dev,
157 struct packet_type *pt, struct net_device *unused)
159 struct dsa_port *cpu_dp = dev->dsa_ptr;
160 struct sk_buff *nskb = NULL;
161 struct pcpu_sw_netstats *s;
162 struct dsa_slave_priv *p;
164 if (unlikely(!cpu_dp)) {
169 skb = skb_unshare(skb, GFP_ATOMIC);
173 nskb = cpu_dp->rcv(skb, dev, pt);
180 p = netdev_priv(skb->dev);
181 skb_push(skb, ETH_HLEN);
182 skb->pkt_type = PACKET_HOST;
183 skb->protocol = eth_type_trans(skb, skb->dev);
185 s = this_cpu_ptr(p->stats64);
186 u64_stats_update_begin(&s->syncp);
188 s->rx_bytes += skb->len;
189 u64_stats_update_end(&s->syncp);
191 if (dsa_skb_defer_rx_timestamp(p, skb))
194 gro_cells_receive(&p->gcells, skb);
199 #ifdef CONFIG_PM_SLEEP
200 static bool dsa_is_port_initialized(struct dsa_switch *ds, int p)
202 return dsa_is_user_port(ds, p) && ds->ports[p].slave;
205 int dsa_switch_suspend(struct dsa_switch *ds)
209 /* Suspend slave network devices */
210 for (i = 0; i < ds->num_ports; i++) {
211 if (!dsa_is_port_initialized(ds, i))
214 ret = dsa_slave_suspend(ds->ports[i].slave);
219 if (ds->ops->suspend)
220 ret = ds->ops->suspend(ds);
224 EXPORT_SYMBOL_GPL(dsa_switch_suspend);
226 int dsa_switch_resume(struct dsa_switch *ds)
231 ret = ds->ops->resume(ds);
236 /* Resume slave network devices */
237 for (i = 0; i < ds->num_ports; i++) {
238 if (!dsa_is_port_initialized(ds, i))
241 ret = dsa_slave_resume(ds->ports[i].slave);
248 EXPORT_SYMBOL_GPL(dsa_switch_resume);
251 static struct packet_type dsa_pack_type __read_mostly = {
252 .type = cpu_to_be16(ETH_P_XDSA),
253 .func = dsa_switch_rcv,
256 static struct workqueue_struct *dsa_owq;
258 bool dsa_schedule_work(struct work_struct *work)
260 return queue_work(dsa_owq, work);
263 static ATOMIC_NOTIFIER_HEAD(dsa_notif_chain);
265 int register_dsa_notifier(struct notifier_block *nb)
267 return atomic_notifier_chain_register(&dsa_notif_chain, nb);
269 EXPORT_SYMBOL_GPL(register_dsa_notifier);
271 int unregister_dsa_notifier(struct notifier_block *nb)
273 return atomic_notifier_chain_unregister(&dsa_notif_chain, nb);
275 EXPORT_SYMBOL_GPL(unregister_dsa_notifier);
277 int call_dsa_notifiers(unsigned long val, struct net_device *dev,
278 struct dsa_notifier_info *info)
281 return atomic_notifier_call_chain(&dsa_notif_chain, val, info);
283 EXPORT_SYMBOL_GPL(call_dsa_notifiers);
285 static int __init dsa_init_module(void)
289 dsa_owq = alloc_ordered_workqueue("dsa_ordered",
294 rc = dsa_slave_register_notifier();
296 goto register_notifier_fail;
298 rc = dsa_legacy_register();
300 goto legacy_register_fail;
302 dev_add_pack(&dsa_pack_type);
306 legacy_register_fail:
307 dsa_slave_unregister_notifier();
308 register_notifier_fail:
309 destroy_workqueue(dsa_owq);
313 module_init(dsa_init_module);
315 static void __exit dsa_cleanup_module(void)
317 dsa_slave_unregister_notifier();
318 dev_remove_pack(&dsa_pack_type);
319 dsa_legacy_unregister();
320 destroy_workqueue(dsa_owq);
322 module_exit(dsa_cleanup_module);
324 MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
325 MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
326 MODULE_LICENSE("GPL");
327 MODULE_ALIAS("platform:dsa");