blob: 528380a3e296001b9c727e9f35e07f403d7f050b [file] [log] [blame]
Lennert Buytenhek91da11f2008-10-07 13:44:02 +00001/*
2 * net/dsa/slave.c - Slave device handling
Lennert Buytenheke84665c2009-03-20 09:52:09 +00003 * Copyright (c) 2008-2009 Marvell Semiconductor
Lennert Buytenhek91da11f2008-10-07 13:44:02 +00004 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 */
10
11#include <linux/list.h>
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -080012#include <linux/etherdevice.h>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000013#include <linux/phy.h>
Florian Fainellia2820542014-10-17 16:02:13 -070014#include <linux/phy_fixed.h>
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -070015#include <linux/of_net.h>
16#include <linux/of_mdio.h>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000017#include "dsa_priv.h"
18
19/* slave mii_bus handling ***************************************************/
20static int dsa_slave_phy_read(struct mii_bus *bus, int addr, int reg)
21{
22 struct dsa_switch *ds = bus->priv;
23
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -070024 if (ds->phys_mii_mask & (1 << addr))
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000025 return ds->drv->phy_read(ds, addr, reg);
26
27 return 0xffff;
28}
29
30static int dsa_slave_phy_write(struct mii_bus *bus, int addr, int reg, u16 val)
31{
32 struct dsa_switch *ds = bus->priv;
33
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -070034 if (ds->phys_mii_mask & (1 << addr))
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000035 return ds->drv->phy_write(ds, addr, reg, val);
36
37 return 0;
38}
39
40void dsa_slave_mii_bus_init(struct dsa_switch *ds)
41{
42 ds->slave_mii_bus->priv = (void *)ds;
43 ds->slave_mii_bus->name = "dsa slave smi";
44 ds->slave_mii_bus->read = dsa_slave_phy_read;
45 ds->slave_mii_bus->write = dsa_slave_phy_write;
Florian Fainellif490be02013-01-21 09:58:50 +000046 snprintf(ds->slave_mii_bus->id, MII_BUS_ID_SIZE, "dsa-%d:%.2x",
47 ds->index, ds->pd->sw_addr);
Alexander Duyckb4d23942014-09-15 13:00:27 -040048 ds->slave_mii_bus->parent = ds->master_dev;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000049}
50
51
52/* slave device handling ****************************************************/
Lennert Buytenhekc0840802009-03-20 09:49:49 +000053static int dsa_slave_init(struct net_device *dev)
54{
55 struct dsa_slave_priv *p = netdev_priv(dev);
Lennert Buytenhekc0840802009-03-20 09:49:49 +000056
Lennert Buytenheke84665c2009-03-20 09:52:09 +000057 dev->iflink = p->parent->dst->master_netdev->ifindex;
Lennert Buytenhekc0840802009-03-20 09:49:49 +000058
59 return 0;
60}
61
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000062static int dsa_slave_open(struct net_device *dev)
63{
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -080064 struct dsa_slave_priv *p = netdev_priv(dev);
Lennert Buytenheke84665c2009-03-20 09:52:09 +000065 struct net_device *master = p->parent->dst->master_netdev;
Florian Fainellib2f2af22014-09-24 17:05:18 -070066 struct dsa_switch *ds = p->parent;
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -080067 int err;
68
69 if (!(master->flags & IFF_UP))
70 return -ENETDOWN;
71
Joe Perches8feedbb2012-05-08 18:56:57 +000072 if (!ether_addr_equal(dev->dev_addr, master->dev_addr)) {
Jiri Pirkoa748ee22010-04-01 21:22:09 +000073 err = dev_uc_add(master, dev->dev_addr);
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -080074 if (err < 0)
75 goto out;
76 }
77
78 if (dev->flags & IFF_ALLMULTI) {
79 err = dev_set_allmulti(master, 1);
80 if (err < 0)
81 goto del_unicast;
82 }
83 if (dev->flags & IFF_PROMISC) {
84 err = dev_set_promiscuity(master, 1);
85 if (err < 0)
86 goto clear_allmulti;
87 }
88
Florian Fainellib2f2af22014-09-24 17:05:18 -070089 if (ds->drv->port_enable) {
90 err = ds->drv->port_enable(ds, p->port, p->phy);
91 if (err)
92 goto clear_promisc;
93 }
94
Florian Fainellif7f1de52014-09-24 17:05:17 -070095 if (p->phy)
96 phy_start(p->phy);
97
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000098 return 0;
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -080099
Florian Fainellib2f2af22014-09-24 17:05:18 -0700100clear_promisc:
101 if (dev->flags & IFF_PROMISC)
102 dev_set_promiscuity(master, 0);
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800103clear_allmulti:
104 if (dev->flags & IFF_ALLMULTI)
105 dev_set_allmulti(master, -1);
106del_unicast:
Joe Perches8feedbb2012-05-08 18:56:57 +0000107 if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
Jiri Pirkoa748ee22010-04-01 21:22:09 +0000108 dev_uc_del(master, dev->dev_addr);
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800109out:
110 return err;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000111}
112
113static int dsa_slave_close(struct net_device *dev)
114{
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800115 struct dsa_slave_priv *p = netdev_priv(dev);
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000116 struct net_device *master = p->parent->dst->master_netdev;
Florian Fainellib2f2af22014-09-24 17:05:18 -0700117 struct dsa_switch *ds = p->parent;
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800118
Florian Fainellif7f1de52014-09-24 17:05:17 -0700119 if (p->phy)
120 phy_stop(p->phy);
121
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800122 dev_mc_unsync(master, dev);
Jiri Pirkoa748ee22010-04-01 21:22:09 +0000123 dev_uc_unsync(master, dev);
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800124 if (dev->flags & IFF_ALLMULTI)
125 dev_set_allmulti(master, -1);
126 if (dev->flags & IFF_PROMISC)
127 dev_set_promiscuity(master, -1);
128
Joe Perches8feedbb2012-05-08 18:56:57 +0000129 if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
Jiri Pirkoa748ee22010-04-01 21:22:09 +0000130 dev_uc_del(master, dev->dev_addr);
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800131
Florian Fainellib2f2af22014-09-24 17:05:18 -0700132 if (ds->drv->port_disable)
133 ds->drv->port_disable(ds, p->port, p->phy);
134
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000135 return 0;
136}
137
138static void dsa_slave_change_rx_flags(struct net_device *dev, int change)
139{
140 struct dsa_slave_priv *p = netdev_priv(dev);
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000141 struct net_device *master = p->parent->dst->master_netdev;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000142
143 if (change & IFF_ALLMULTI)
144 dev_set_allmulti(master, dev->flags & IFF_ALLMULTI ? 1 : -1);
145 if (change & IFF_PROMISC)
146 dev_set_promiscuity(master, dev->flags & IFF_PROMISC ? 1 : -1);
147}
148
149static void dsa_slave_set_rx_mode(struct net_device *dev)
150{
151 struct dsa_slave_priv *p = netdev_priv(dev);
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000152 struct net_device *master = p->parent->dst->master_netdev;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000153
154 dev_mc_sync(master, dev);
Jiri Pirkoa748ee22010-04-01 21:22:09 +0000155 dev_uc_sync(master, dev);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000156}
157
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800158static int dsa_slave_set_mac_address(struct net_device *dev, void *a)
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000159{
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800160 struct dsa_slave_priv *p = netdev_priv(dev);
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000161 struct net_device *master = p->parent->dst->master_netdev;
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800162 struct sockaddr *addr = a;
163 int err;
164
165 if (!is_valid_ether_addr(addr->sa_data))
166 return -EADDRNOTAVAIL;
167
168 if (!(dev->flags & IFF_UP))
169 goto out;
170
Joe Perches8feedbb2012-05-08 18:56:57 +0000171 if (!ether_addr_equal(addr->sa_data, master->dev_addr)) {
Jiri Pirkoa748ee22010-04-01 21:22:09 +0000172 err = dev_uc_add(master, addr->sa_data);
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800173 if (err < 0)
174 return err;
175 }
176
Joe Perches8feedbb2012-05-08 18:56:57 +0000177 if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
Jiri Pirkoa748ee22010-04-01 21:22:09 +0000178 dev_uc_del(master, dev->dev_addr);
Lennert Buytenhekdf02c6f2008-11-10 21:53:12 -0800179
180out:
Joe Perchesd08f1612014-01-20 09:52:20 -0800181 ether_addr_copy(dev->dev_addr, addr->sa_data);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000182
183 return 0;
184}
185
186static int dsa_slave_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
187{
188 struct dsa_slave_priv *p = netdev_priv(dev);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000189
190 if (p->phy != NULL)
Richard Cochran28b04112010-07-17 08:48:55 +0000191 return phy_mii_ioctl(p->phy, ifr, cmd);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000192
193 return -EOPNOTSUPP;
194}
195
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700196static netdev_tx_t dsa_slave_xmit(struct sk_buff *skb, struct net_device *dev)
197{
198 struct dsa_slave_priv *p = netdev_priv(dev);
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700199
Alexander Duyck50753142014-09-15 13:00:19 -0400200 return p->xmit(skb, dev);
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700201}
202
Florian Fainelli5aed85c2014-08-27 17:04:52 -0700203static netdev_tx_t dsa_slave_notag_xmit(struct sk_buff *skb,
204 struct net_device *dev)
205{
206 struct dsa_slave_priv *p = netdev_priv(dev);
207
208 skb->dev = p->parent->dst->master_netdev;
209 dev_queue_xmit(skb);
210
211 return NETDEV_TX_OK;
212}
213
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000214
215/* ethtool operations *******************************************************/
216static int
217dsa_slave_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
218{
219 struct dsa_slave_priv *p = netdev_priv(dev);
220 int err;
221
222 err = -EOPNOTSUPP;
223 if (p->phy != NULL) {
224 err = phy_read_status(p->phy);
225 if (err == 0)
226 err = phy_ethtool_gset(p->phy, cmd);
227 }
228
229 return err;
230}
231
232static int
233dsa_slave_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
234{
235 struct dsa_slave_priv *p = netdev_priv(dev);
236
237 if (p->phy != NULL)
238 return phy_ethtool_sset(p->phy, cmd);
239
240 return -EOPNOTSUPP;
241}
242
243static void dsa_slave_get_drvinfo(struct net_device *dev,
244 struct ethtool_drvinfo *drvinfo)
245{
Jiri Pirko7826d432013-01-06 00:44:26 +0000246 strlcpy(drvinfo->driver, "dsa", sizeof(drvinfo->driver));
247 strlcpy(drvinfo->version, dsa_driver_version, sizeof(drvinfo->version));
248 strlcpy(drvinfo->fw_version, "N/A", sizeof(drvinfo->fw_version));
249 strlcpy(drvinfo->bus_info, "platform", sizeof(drvinfo->bus_info));
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000250}
251
Guenter Roeck3d762a02014-10-29 10:45:04 -0700252static int dsa_slave_get_regs_len(struct net_device *dev)
253{
254 struct dsa_slave_priv *p = netdev_priv(dev);
255 struct dsa_switch *ds = p->parent;
256
257 if (ds->drv->get_regs_len)
258 return ds->drv->get_regs_len(ds, p->port);
259
260 return -EOPNOTSUPP;
261}
262
263static void
264dsa_slave_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *_p)
265{
266 struct dsa_slave_priv *p = netdev_priv(dev);
267 struct dsa_switch *ds = p->parent;
268
269 if (ds->drv->get_regs)
270 ds->drv->get_regs(ds, p->port, regs, _p);
271}
272
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000273static int dsa_slave_nway_reset(struct net_device *dev)
274{
275 struct dsa_slave_priv *p = netdev_priv(dev);
276
277 if (p->phy != NULL)
278 return genphy_restart_aneg(p->phy);
279
280 return -EOPNOTSUPP;
281}
282
283static u32 dsa_slave_get_link(struct net_device *dev)
284{
285 struct dsa_slave_priv *p = netdev_priv(dev);
286
287 if (p->phy != NULL) {
288 genphy_update_link(p->phy);
289 return p->phy->link;
290 }
291
292 return -EOPNOTSUPP;
293}
294
Guenter Roeck6793abb2014-10-29 10:45:01 -0700295static int dsa_slave_get_eeprom_len(struct net_device *dev)
296{
297 struct dsa_slave_priv *p = netdev_priv(dev);
298 struct dsa_switch *ds = p->parent;
299
300 if (ds->pd->eeprom_len)
301 return ds->pd->eeprom_len;
302
303 if (ds->drv->get_eeprom_len)
304 return ds->drv->get_eeprom_len(ds);
305
306 return 0;
307}
308
309static int dsa_slave_get_eeprom(struct net_device *dev,
310 struct ethtool_eeprom *eeprom, u8 *data)
311{
312 struct dsa_slave_priv *p = netdev_priv(dev);
313 struct dsa_switch *ds = p->parent;
314
315 if (ds->drv->get_eeprom)
316 return ds->drv->get_eeprom(ds, eeprom, data);
317
318 return -EOPNOTSUPP;
319}
320
321static int dsa_slave_set_eeprom(struct net_device *dev,
322 struct ethtool_eeprom *eeprom, u8 *data)
323{
324 struct dsa_slave_priv *p = netdev_priv(dev);
325 struct dsa_switch *ds = p->parent;
326
327 if (ds->drv->set_eeprom)
328 return ds->drv->set_eeprom(ds, eeprom, data);
329
330 return -EOPNOTSUPP;
331}
332
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000333static void dsa_slave_get_strings(struct net_device *dev,
334 uint32_t stringset, uint8_t *data)
335{
336 struct dsa_slave_priv *p = netdev_priv(dev);
337 struct dsa_switch *ds = p->parent;
338
339 if (stringset == ETH_SS_STATS) {
340 int len = ETH_GSTRING_LEN;
341
342 strncpy(data, "tx_packets", len);
343 strncpy(data + len, "tx_bytes", len);
344 strncpy(data + 2 * len, "rx_packets", len);
345 strncpy(data + 3 * len, "rx_bytes", len);
346 if (ds->drv->get_strings != NULL)
347 ds->drv->get_strings(ds, p->port, data + 4 * len);
348 }
349}
350
351static void dsa_slave_get_ethtool_stats(struct net_device *dev,
352 struct ethtool_stats *stats,
353 uint64_t *data)
354{
355 struct dsa_slave_priv *p = netdev_priv(dev);
356 struct dsa_switch *ds = p->parent;
357
358 data[0] = p->dev->stats.tx_packets;
359 data[1] = p->dev->stats.tx_bytes;
360 data[2] = p->dev->stats.rx_packets;
361 data[3] = p->dev->stats.rx_bytes;
362 if (ds->drv->get_ethtool_stats != NULL)
363 ds->drv->get_ethtool_stats(ds, p->port, data + 4);
364}
365
366static int dsa_slave_get_sset_count(struct net_device *dev, int sset)
367{
368 struct dsa_slave_priv *p = netdev_priv(dev);
369 struct dsa_switch *ds = p->parent;
370
371 if (sset == ETH_SS_STATS) {
372 int count;
373
374 count = 4;
375 if (ds->drv->get_sset_count != NULL)
376 count += ds->drv->get_sset_count(ds);
377
378 return count;
379 }
380
381 return -EOPNOTSUPP;
382}
383
Florian Fainelli19e57c42014-09-18 17:31:24 -0700384static void dsa_slave_get_wol(struct net_device *dev, struct ethtool_wolinfo *w)
385{
386 struct dsa_slave_priv *p = netdev_priv(dev);
387 struct dsa_switch *ds = p->parent;
388
389 if (ds->drv->get_wol)
390 ds->drv->get_wol(ds, p->port, w);
391}
392
393static int dsa_slave_set_wol(struct net_device *dev, struct ethtool_wolinfo *w)
394{
395 struct dsa_slave_priv *p = netdev_priv(dev);
396 struct dsa_switch *ds = p->parent;
397 int ret = -EOPNOTSUPP;
398
399 if (ds->drv->set_wol)
400 ret = ds->drv->set_wol(ds, p->port, w);
401
402 return ret;
403}
404
Florian Fainelli79052882014-09-24 17:05:21 -0700405static int dsa_slave_set_eee(struct net_device *dev, struct ethtool_eee *e)
406{
407 struct dsa_slave_priv *p = netdev_priv(dev);
408 struct dsa_switch *ds = p->parent;
409 int ret;
410
411 if (!ds->drv->set_eee)
412 return -EOPNOTSUPP;
413
414 ret = ds->drv->set_eee(ds, p->port, p->phy, e);
415 if (ret)
416 return ret;
417
418 if (p->phy)
419 ret = phy_ethtool_set_eee(p->phy, e);
420
421 return ret;
422}
423
424static int dsa_slave_get_eee(struct net_device *dev, struct ethtool_eee *e)
425{
426 struct dsa_slave_priv *p = netdev_priv(dev);
427 struct dsa_switch *ds = p->parent;
428 int ret;
429
430 if (!ds->drv->get_eee)
431 return -EOPNOTSUPP;
432
433 ret = ds->drv->get_eee(ds, p->port, e);
434 if (ret)
435 return ret;
436
437 if (p->phy)
438 ret = phy_ethtool_get_eee(p->phy, e);
439
440 return ret;
441}
442
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000443static const struct ethtool_ops dsa_slave_ethtool_ops = {
444 .get_settings = dsa_slave_get_settings,
445 .set_settings = dsa_slave_set_settings,
446 .get_drvinfo = dsa_slave_get_drvinfo,
Guenter Roeck3d762a02014-10-29 10:45:04 -0700447 .get_regs_len = dsa_slave_get_regs_len,
448 .get_regs = dsa_slave_get_regs,
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000449 .nway_reset = dsa_slave_nway_reset,
450 .get_link = dsa_slave_get_link,
Guenter Roeck6793abb2014-10-29 10:45:01 -0700451 .get_eeprom_len = dsa_slave_get_eeprom_len,
452 .get_eeprom = dsa_slave_get_eeprom,
453 .set_eeprom = dsa_slave_set_eeprom,
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000454 .get_strings = dsa_slave_get_strings,
455 .get_ethtool_stats = dsa_slave_get_ethtool_stats,
456 .get_sset_count = dsa_slave_get_sset_count,
Florian Fainelli19e57c42014-09-18 17:31:24 -0700457 .set_wol = dsa_slave_set_wol,
458 .get_wol = dsa_slave_get_wol,
Florian Fainelli79052882014-09-24 17:05:21 -0700459 .set_eee = dsa_slave_set_eee,
460 .get_eee = dsa_slave_get_eee,
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000461};
462
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700463static const struct net_device_ops dsa_slave_netdev_ops = {
Lennert Buytenhekc0840802009-03-20 09:49:49 +0000464 .ndo_init = dsa_slave_init,
Stephen Hemmingerd442ad42009-01-06 16:45:26 -0800465 .ndo_open = dsa_slave_open,
466 .ndo_stop = dsa_slave_close,
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700467 .ndo_start_xmit = dsa_slave_xmit,
Stephen Hemmingerd442ad42009-01-06 16:45:26 -0800468 .ndo_change_rx_flags = dsa_slave_change_rx_flags,
469 .ndo_set_rx_mode = dsa_slave_set_rx_mode,
Stephen Hemmingerd442ad42009-01-06 16:45:26 -0800470 .ndo_set_mac_address = dsa_slave_set_mac_address,
471 .ndo_do_ioctl = dsa_slave_ioctl,
472};
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000473
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700474static void dsa_slave_adjust_link(struct net_device *dev)
475{
476 struct dsa_slave_priv *p = netdev_priv(dev);
Florian Fainelliec9436b2014-08-27 17:04:53 -0700477 struct dsa_switch *ds = p->parent;
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700478 unsigned int status_changed = 0;
479
480 if (p->old_link != p->phy->link) {
481 status_changed = 1;
482 p->old_link = p->phy->link;
483 }
484
485 if (p->old_duplex != p->phy->duplex) {
486 status_changed = 1;
487 p->old_duplex = p->phy->duplex;
488 }
489
490 if (p->old_pause != p->phy->pause) {
491 status_changed = 1;
492 p->old_pause = p->phy->pause;
493 }
494
Florian Fainelliec9436b2014-08-27 17:04:53 -0700495 if (ds->drv->adjust_link && status_changed)
496 ds->drv->adjust_link(ds, p->port, p->phy);
497
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700498 if (status_changed)
499 phy_print_status(p->phy);
500}
501
Florian Fainellice31b312014-08-27 17:04:54 -0700502static int dsa_slave_fixed_link_update(struct net_device *dev,
503 struct fixed_phy_status *status)
504{
505 struct dsa_slave_priv *p = netdev_priv(dev);
506 struct dsa_switch *ds = p->parent;
507
508 if (ds->drv->fixed_link_update)
509 ds->drv->fixed_link_update(ds, p->port, status);
510
511 return 0;
512}
513
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000514/* slave device setup *******************************************************/
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700515static void dsa_slave_phy_setup(struct dsa_slave_priv *p,
516 struct net_device *slave_dev)
517{
518 struct dsa_switch *ds = p->parent;
519 struct dsa_chip_data *cd = ds->pd;
520 struct device_node *phy_dn, *port_dn;
Florian Fainellice31b312014-08-27 17:04:54 -0700521 bool phy_is_fixed = false;
Florian Fainelli68195632014-09-19 13:07:54 -0700522 u32 phy_flags = 0;
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700523 int ret;
524
525 port_dn = cd->port_dn[p->port];
526 p->phy_interface = of_get_phy_mode(port_dn);
527
528 phy_dn = of_parse_phandle(port_dn, "phy-handle", 0);
529 if (of_phy_is_fixed_link(port_dn)) {
530 /* In the case of a fixed PHY, the DT node associated
531 * to the fixed PHY is the Port DT node
532 */
533 ret = of_phy_register_fixed_link(port_dn);
534 if (ret) {
Joe Perchesa2ae6002014-11-09 16:32:46 -0800535 netdev_err(slave_dev, "failed to register fixed PHY\n");
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700536 return;
537 }
Florian Fainellice31b312014-08-27 17:04:54 -0700538 phy_is_fixed = true;
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700539 phy_dn = port_dn;
540 }
541
Florian Fainelli68195632014-09-19 13:07:54 -0700542 if (ds->drv->get_phy_flags)
543 phy_flags = ds->drv->get_phy_flags(ds, p->port);
544
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700545 if (phy_dn)
546 p->phy = of_phy_connect(slave_dev, phy_dn,
Florian Fainelli68195632014-09-19 13:07:54 -0700547 dsa_slave_adjust_link, phy_flags,
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700548 p->phy_interface);
549
Florian Fainellice31b312014-08-27 17:04:54 -0700550 if (p->phy && phy_is_fixed)
551 fixed_phy_set_link_update(p->phy, dsa_slave_fixed_link_update);
552
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700553 /* We could not connect to a designated PHY, so use the switch internal
554 * MDIO bus instead
555 */
Andrew Lunnb31f65f2014-11-05 19:47:28 +0100556 if (!p->phy) {
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700557 p->phy = ds->slave_mii_bus->phy_map[p->port];
Andrew Lunnb31f65f2014-11-05 19:47:28 +0100558 phy_connect_direct(slave_dev, p->phy, dsa_slave_adjust_link,
559 p->phy_interface);
560 } else {
Joe Perchesa2ae6002014-11-09 16:32:46 -0800561 netdev_info(slave_dev, "attached PHY at address %d [%s]\n",
562 p->phy->addr, p->phy->drv->name);
Andrew Lunnb31f65f2014-11-05 19:47:28 +0100563 }
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700564}
565
Florian Fainelli24462542014-09-18 17:31:22 -0700566int dsa_slave_suspend(struct net_device *slave_dev)
567{
568 struct dsa_slave_priv *p = netdev_priv(slave_dev);
569
570 netif_device_detach(slave_dev);
571
572 if (p->phy) {
573 phy_stop(p->phy);
574 p->old_pause = -1;
575 p->old_link = -1;
576 p->old_duplex = -1;
577 phy_suspend(p->phy);
578 }
579
580 return 0;
581}
582
583int dsa_slave_resume(struct net_device *slave_dev)
584{
585 struct dsa_slave_priv *p = netdev_priv(slave_dev);
586
587 netif_device_attach(slave_dev);
588
589 if (p->phy) {
590 phy_resume(p->phy);
591 phy_start(p->phy);
592 }
593
594 return 0;
595}
596
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000597struct net_device *
598dsa_slave_create(struct dsa_switch *ds, struct device *parent,
599 int port, char *name)
600{
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000601 struct net_device *master = ds->dst->master_netdev;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000602 struct net_device *slave_dev;
603 struct dsa_slave_priv *p;
604 int ret;
605
Tom Gundersenc835a672014-07-14 16:37:24 +0200606 slave_dev = alloc_netdev(sizeof(struct dsa_slave_priv), name,
607 NET_NAME_UNKNOWN, ether_setup);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000608 if (slave_dev == NULL)
609 return slave_dev;
610
611 slave_dev->features = master->vlan_features;
Wilfried Klaebe7ad24ea2014-05-11 00:12:32 +0000612 slave_dev->ethtool_ops = &dsa_slave_ethtool_ops;
Bjørn Mork2fcc8002013-08-30 18:08:46 +0200613 eth_hw_addr_inherit(slave_dev, master);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000614 slave_dev->tx_queue_len = 0;
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700615 slave_dev->netdev_ops = &dsa_slave_netdev_ops;
Stephen Hemmingerd442ad42009-01-06 16:45:26 -0800616
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000617 SET_NETDEV_DEV(slave_dev, parent);
Florian Fainellibd474972014-08-27 17:04:50 -0700618 slave_dev->dev.of_node = ds->pd->port_dn[port];
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000619 slave_dev->vlan_features = master->vlan_features;
620
621 p = netdev_priv(slave_dev);
622 p->dev = slave_dev;
623 p->parent = ds;
624 p->port = port;
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700625
Alexander Duyck50753142014-09-15 13:00:19 -0400626 switch (ds->dst->tag_protocol) {
627#ifdef CONFIG_NET_DSA_TAG_DSA
628 case DSA_TAG_PROTO_DSA:
629 p->xmit = dsa_netdev_ops.xmit;
630 break;
631#endif
632#ifdef CONFIG_NET_DSA_TAG_EDSA
633 case DSA_TAG_PROTO_EDSA:
634 p->xmit = edsa_netdev_ops.xmit;
635 break;
636#endif
637#ifdef CONFIG_NET_DSA_TAG_TRAILER
638 case DSA_TAG_PROTO_TRAILER:
639 p->xmit = trailer_netdev_ops.xmit;
640 break;
641#endif
642#ifdef CONFIG_NET_DSA_TAG_BRCM
643 case DSA_TAG_PROTO_BRCM:
644 p->xmit = brcm_netdev_ops.xmit;
645 break;
646#endif
647 default:
648 p->xmit = dsa_slave_notag_xmit;
649 break;
650 }
651
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700652 p->old_pause = -1;
653 p->old_link = -1;
654 p->old_duplex = -1;
655
656 dsa_slave_phy_setup(p, slave_dev);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000657
658 ret = register_netdev(slave_dev);
659 if (ret) {
Joe Perchesa2ae6002014-11-09 16:32:46 -0800660 netdev_err(master, "error %d registering interface %s\n",
661 ret, slave_dev->name);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000662 free_netdev(slave_dev);
663 return NULL;
664 }
665
666 netif_carrier_off(slave_dev);
667
668 if (p->phy != NULL) {
Andrew Lunn228b16c2014-10-19 16:41:47 +0200669 if (ds->drv->get_phy_flags)
Florian Fainelli68195632014-09-19 13:07:54 -0700670 p->phy->dev_flags |= ds->drv->get_phy_flags(ds, port);
671
Kay Sieversfb28ad32008-11-10 13:55:14 -0800672 phy_attach(slave_dev, dev_name(&p->phy->dev),
Florian Fainellif9a8f832013-01-14 00:52:52 +0000673 PHY_INTERFACE_MODE_GMII);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000674
675 p->phy->autoneg = AUTONEG_ENABLE;
676 p->phy->speed = 0;
677 p->phy->duplex = 0;
678 p->phy->advertising = p->phy->supported | ADVERTISED_Autoneg;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000679 }
680
681 return slave_dev;
682}