blob: 26130ae438da53f3f99a4e9fa712a572f40ca779 [file] [log] [blame]
Lennert Buytenhek91da11f2008-10-07 13:44:02 +00001/*
2 * net/dsa/dsa.c - Hardware switch handling
Lennert Buytenheke84665c2009-03-20 09:52:09 +00003 * Copyright (c) 2008-2009 Marvell Semiconductor
Florian Fainelli5e95329b2013-03-22 10:50:50 +00004 * Copyright (c) 2013 Florian Fainelli <florian@openwrt.org>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +00005 *
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
Guenter Roeck51579c32014-10-29 10:44:58 -070012#include <linux/device.h>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000013#include <linux/list.h>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000014#include <linux/platform_device.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090015#include <linux/slab.h>
Paul Gortmaker3a9a2312011-05-27 09:12:25 -040016#include <linux/module.h>
Florian Fainelli5e95329b2013-03-22 10:50:50 +000017#include <linux/of.h>
18#include <linux/of_mdio.h>
19#include <linux/of_platform.h>
Florian Fainelli769a0202015-03-09 14:31:21 -070020#include <linux/of_net.h>
Andrew Lunncc30c162015-11-20 03:56:23 +010021#include <linux/of_gpio.h>
Andrew Lunnc6e970a2017-03-28 23:45:06 +020022#include <linux/netdevice.h>
Guenter Roeck51579c32014-10-29 10:44:58 -070023#include <linux/sysfs.h>
Neil Armstrongcbc5d902015-10-06 15:40:32 +010024#include <linux/phy_fixed.h>
Arnd Bergmann85beabf2015-11-24 12:34:49 +010025#include <linux/gpio/consumer.h>
Florian Fainellia86d8be2017-04-08 08:55:23 -070026#include <linux/etherdevice.h>
Andrew Lunnc6e970a2017-03-28 23:45:06 +020027#include <net/dsa.h>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000028#include "dsa_priv.h"
29
Andrew Lunn39a7f2a2016-06-04 21:17:03 +020030static 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
37static const struct dsa_device_ops none_ops = {
38 .xmit = dsa_slave_notag_xmit,
39 .rcv = NULL,
40};
41
42const struct dsa_device_ops *dsa_device_ops[DSA_TAG_LAST] = {
43#ifdef CONFIG_NET_DSA_TAG_DSA
44 [DSA_TAG_PROTO_DSA] = &dsa_netdev_ops,
45#endif
46#ifdef CONFIG_NET_DSA_TAG_EDSA
47 [DSA_TAG_PROTO_EDSA] = &edsa_netdev_ops,
48#endif
49#ifdef CONFIG_NET_DSA_TAG_TRAILER
50 [DSA_TAG_PROTO_TRAILER] = &trailer_netdev_ops,
51#endif
52#ifdef CONFIG_NET_DSA_TAG_BRCM
53 [DSA_TAG_PROTO_BRCM] = &brcm_netdev_ops,
54#endif
John Crispincafdc452016-09-15 16:26:40 +020055#ifdef CONFIG_NET_DSA_TAG_QCA
56 [DSA_TAG_PROTO_QCA] = &qca_netdev_ops,
57#endif
Sean Wang5cd89852017-04-07 16:45:06 +080058#ifdef CONFIG_NET_DSA_TAG_MTK
59 [DSA_TAG_PROTO_MTK] = &mtk_netdev_ops,
60#endif
Juergen Beiserte8fe1772017-04-18 10:48:24 +020061#ifdef CONFIG_NET_DSA_TAG_LAN9303
62 [DSA_TAG_PROTO_LAN9303] = &lan9303_netdev_ops,
63#endif
Andrew Lunn39a7f2a2016-06-04 21:17:03 +020064 [DSA_TAG_PROTO_NONE] = &none_ops,
65};
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000066
Andrew Lunn9b8e8952016-06-04 21:17:01 +020067int dsa_cpu_dsa_setup(struct dsa_switch *ds, struct device *dev,
Florian Fainelli293784a2017-01-26 10:45:52 -080068 struct dsa_port *dport, int port)
Andrew Lunn9b8e8952016-06-04 21:17:01 +020069{
Florian Fainelli293784a2017-01-26 10:45:52 -080070 struct device_node *port_dn = dport->dn;
Andrew Lunn9b8e8952016-06-04 21:17:01 +020071 struct phy_device *phydev;
72 int ret, mode;
73
74 if (of_phy_is_fixed_link(port_dn)) {
75 ret = of_phy_register_fixed_link(port_dn);
76 if (ret) {
77 dev_err(dev, "failed to register fixed PHY\n");
78 return ret;
79 }
80 phydev = of_phy_find_device(port_dn);
81
82 mode = of_get_phy_mode(port_dn);
83 if (mode < 0)
84 mode = PHY_INTERFACE_MODE_NA;
85 phydev->interface = mode;
86
87 genphy_config_init(phydev);
88 genphy_read_status(phydev);
Vivien Didelot9d490b42016-08-23 12:38:56 -040089 if (ds->ops->adjust_link)
90 ds->ops->adjust_link(ds, port, phydev);
Johan Hovoldfd05d7b2016-11-24 19:21:27 +010091
92 put_device(&phydev->mdio.dev);
Andrew Lunn9b8e8952016-06-04 21:17:01 +020093 }
94
95 return 0;
96}
97
Andrew Lunn39a7f2a2016-06-04 21:17:03 +020098const struct dsa_device_ops *dsa_resolve_tag_protocol(int tag_protocol)
99{
100 const struct dsa_device_ops *ops;
101
102 if (tag_protocol >= DSA_TAG_LAST)
103 return ERR_PTR(-EINVAL);
104 ops = dsa_device_ops[tag_protocol];
105
106 if (!ops)
107 return ERR_PTR(-ENOPROTOOPT);
108
109 return ops;
110}
111
Florian Fainelli0c73c522016-06-07 16:32:42 -0700112int dsa_cpu_port_ethtool_setup(struct dsa_switch *ds)
113{
114 struct net_device *master;
115 struct ethtool_ops *cpu_ops;
116
117 master = ds->dst->master_netdev;
118 if (ds->master_netdev)
119 master = ds->master_netdev;
120
121 cpu_ops = devm_kzalloc(ds->dev, sizeof(*cpu_ops), GFP_KERNEL);
122 if (!cpu_ops)
123 return -ENOMEM;
124
125 memcpy(&ds->dst->master_ethtool_ops, master->ethtool_ops,
126 sizeof(struct ethtool_ops));
127 ds->dst->master_orig_ethtool_ops = master->ethtool_ops;
128 memcpy(cpu_ops, &ds->dst->master_ethtool_ops,
129 sizeof(struct ethtool_ops));
130 dsa_cpu_port_ethtool_init(cpu_ops);
131 master->ethtool_ops = cpu_ops;
132
133 return 0;
134}
135
136void dsa_cpu_port_ethtool_restore(struct dsa_switch *ds)
137{
138 struct net_device *master;
139
140 master = ds->dst->master_netdev;
141 if (ds->master_netdev)
142 master = ds->master_netdev;
143
144 master->ethtool_ops = ds->dst->master_orig_ethtool_ops;
145}
146
Florian Fainelli293784a2017-01-26 10:45:52 -0800147void dsa_cpu_dsa_destroy(struct dsa_port *port)
Andrew Lunn9b8e8952016-06-04 21:17:01 +0200148{
Florian Fainelli293784a2017-01-26 10:45:52 -0800149 struct device_node *port_dn = port->dn;
150
Johan Hovold3f650472016-11-28 19:24:55 +0100151 if (of_phy_is_fixed_link(port_dn))
152 of_phy_deregister_fixed_link(port_dn);
Andrew Lunn9b8e8952016-06-04 21:17:01 +0200153}
154
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000155static int dev_is_class(struct device *dev, void *class)
156{
157 if (dev->class != NULL && !strcmp(dev->class->name, class))
158 return 1;
159
160 return 0;
161}
162
163static struct device *dev_find_class(struct device *parent, char *class)
164{
165 if (dev_is_class(parent, class)) {
166 get_device(parent);
167 return parent;
168 }
169
170 return device_find_child(parent, class, dev_is_class);
171}
172
Florian Fainelli14b89f32017-02-04 13:02:42 -0800173struct net_device *dsa_dev_to_net_device(struct device *dev)
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000174{
175 struct device *d;
176
177 d = dev_find_class(dev, "net");
178 if (d != NULL) {
179 struct net_device *nd;
180
181 nd = to_net_dev(d);
182 dev_hold(nd);
183 put_device(d);
184
185 return nd;
186 }
187
188 return NULL;
189}
Florian Fainelli14b89f32017-02-04 13:02:42 -0800190EXPORT_SYMBOL_GPL(dsa_dev_to_net_device);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000191
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700192static int dsa_switch_rcv(struct sk_buff *skb, struct net_device *dev,
193 struct packet_type *pt, struct net_device *orig_dev)
194{
195 struct dsa_switch_tree *dst = dev->dsa_ptr;
Florian Fainellia86d8be2017-04-08 08:55:23 -0700196 struct sk_buff *nskb = NULL;
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700197
198 if (unlikely(dst == NULL)) {
199 kfree_skb(skb);
200 return 0;
201 }
202
Florian Fainelli16c5dcb2017-04-08 08:55:22 -0700203 skb = skb_unshare(skb, GFP_ATOMIC);
204 if (!skb)
205 return 0;
206
Florian Fainellia86d8be2017-04-08 08:55:23 -0700207 nskb = dst->rcv(skb, dev, pt, orig_dev);
208 if (!nskb) {
209 kfree_skb(skb);
210 return 0;
211 }
212
213 skb = nskb;
214 skb_push(skb, ETH_HLEN);
215 skb->pkt_type = PACKET_HOST;
216 skb->protocol = eth_type_trans(skb, skb->dev);
217
218 skb->dev->stats.rx_packets++;
219 skb->dev->stats.rx_bytes += skb->len;
220
221 netif_receive_skb(skb);
222
223 return 0;
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700224}
225
Florian Fainelli61b73632014-08-29 12:42:07 -0700226static struct packet_type dsa_pack_type __read_mostly = {
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700227 .type = cpu_to_be16(ETH_P_XDSA),
228 .func = dsa_switch_rcv,
229};
230
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000231static int __init dsa_init_module(void)
232{
Ben Hutchings7df899c2011-11-25 14:35:02 +0000233 int rc;
234
Vivien Didelot88e4f0c2017-02-03 13:20:16 -0500235 rc = dsa_slave_register_notifier();
236 if (rc)
237 return rc;
Florian Fainellib73adef2015-02-24 13:15:33 -0800238
Vivien Didelota6a71f12017-04-12 12:45:03 -0400239 rc = dsa_legacy_register();
Ben Hutchings7df899c2011-11-25 14:35:02 +0000240 if (rc)
241 return rc;
242
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700243 dev_add_pack(&dsa_pack_type);
244
Ben Hutchings7df899c2011-11-25 14:35:02 +0000245 return 0;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000246}
247module_init(dsa_init_module);
248
249static void __exit dsa_cleanup_module(void)
250{
Vivien Didelot88e4f0c2017-02-03 13:20:16 -0500251 dsa_slave_unregister_notifier();
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700252 dev_remove_pack(&dsa_pack_type);
Vivien Didelota6a71f12017-04-12 12:45:03 -0400253 dsa_legacy_unregister();
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000254}
255module_exit(dsa_cleanup_module);
256
Rusty Russell577d6a72011-01-24 14:32:52 -0600257MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000258MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
259MODULE_LICENSE("GPL");
260MODULE_ALIAS("platform:dsa");