slave.c 9.53 KB
Newer Older
1 2
/*
 * net/dsa/slave.c - Slave device handling
3
 * Copyright (c) 2008-2009 Marvell Semiconductor
4 5 6 7 8 9 10 11 12
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 */

#include <linux/list.h>
#include <linux/netdevice.h>
13
#include <linux/etherdevice.h>
14 15 16 17 18 19 20 21
#include <linux/phy.h>
#include "dsa_priv.h"

/* slave mii_bus handling ***************************************************/
static int dsa_slave_phy_read(struct mii_bus *bus, int addr, int reg)
{
	struct dsa_switch *ds = bus->priv;

22
	if (ds->phys_port_mask & (1 << addr))
23 24 25 26 27 28 29 30 31
		return ds->drv->phy_read(ds, addr, reg);

	return 0xffff;
}

static int dsa_slave_phy_write(struct mii_bus *bus, int addr, int reg, u16 val)
{
	struct dsa_switch *ds = bus->priv;

32
	if (ds->phys_port_mask & (1 << addr))
33 34 35 36 37 38 39 40 41 42 43
		return ds->drv->phy_write(ds, addr, reg, val);

	return 0;
}

void dsa_slave_mii_bus_init(struct dsa_switch *ds)
{
	ds->slave_mii_bus->priv = (void *)ds;
	ds->slave_mii_bus->name = "dsa slave smi";
	ds->slave_mii_bus->read = dsa_slave_phy_read;
	ds->slave_mii_bus->write = dsa_slave_phy_write;
44 45
	snprintf(ds->slave_mii_bus->id, MII_BUS_ID_SIZE, "dsa-%d:%.2x",
			ds->index, ds->pd->sw_addr);
46
	ds->slave_mii_bus->parent = &ds->master_mii_bus->dev;
47 48 49 50
}


/* slave device handling ****************************************************/
51 52 53 54
static int dsa_slave_init(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);

55
	dev->iflink = p->parent->dst->master_netdev->ifindex;
56 57 58 59

	return 0;
}

60 61
static int dsa_slave_open(struct net_device *dev)
{
62
	struct dsa_slave_priv *p = netdev_priv(dev);
63
	struct net_device *master = p->parent->dst->master_netdev;
64 65 66 67 68
	int err;

	if (!(master->flags & IFF_UP))
		return -ENETDOWN;

69
	if (!ether_addr_equal(dev->dev_addr, master->dev_addr)) {
70
		err = dev_uc_add(master, dev->dev_addr);
71 72 73 74 75 76 77 78 79 80 81 82 83 84 85
		if (err < 0)
			goto out;
	}

	if (dev->flags & IFF_ALLMULTI) {
		err = dev_set_allmulti(master, 1);
		if (err < 0)
			goto del_unicast;
	}
	if (dev->flags & IFF_PROMISC) {
		err = dev_set_promiscuity(master, 1);
		if (err < 0)
			goto clear_allmulti;
	}

86
	return 0;
87 88 89 90 91

clear_allmulti:
	if (dev->flags & IFF_ALLMULTI)
		dev_set_allmulti(master, -1);
del_unicast:
92
	if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
93
		dev_uc_del(master, dev->dev_addr);
94 95
out:
	return err;
96 97 98 99
}

static int dsa_slave_close(struct net_device *dev)
{
100
	struct dsa_slave_priv *p = netdev_priv(dev);
101
	struct net_device *master = p->parent->dst->master_netdev;
102 103

	dev_mc_unsync(master, dev);
104
	dev_uc_unsync(master, dev);
105 106 107 108 109
	if (dev->flags & IFF_ALLMULTI)
		dev_set_allmulti(master, -1);
	if (dev->flags & IFF_PROMISC)
		dev_set_promiscuity(master, -1);

110
	if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
111
		dev_uc_del(master, dev->dev_addr);
112

113 114 115 116 117 118
	return 0;
}

static void dsa_slave_change_rx_flags(struct net_device *dev, int change)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
119
	struct net_device *master = p->parent->dst->master_netdev;
120 121 122 123 124 125 126 127 128 129

	if (change & IFF_ALLMULTI)
		dev_set_allmulti(master, dev->flags & IFF_ALLMULTI ? 1 : -1);
	if (change & IFF_PROMISC)
		dev_set_promiscuity(master, dev->flags & IFF_PROMISC ? 1 : -1);
}

static void dsa_slave_set_rx_mode(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
130
	struct net_device *master = p->parent->dst->master_netdev;
131 132

	dev_mc_sync(master, dev);
133
	dev_uc_sync(master, dev);
134 135
}

136
static int dsa_slave_set_mac_address(struct net_device *dev, void *a)
137
{
138
	struct dsa_slave_priv *p = netdev_priv(dev);
139
	struct net_device *master = p->parent->dst->master_netdev;
140 141 142 143 144 145 146 147 148
	struct sockaddr *addr = a;
	int err;

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

	if (!(dev->flags & IFF_UP))
		goto out;

149
	if (!ether_addr_equal(addr->sa_data, master->dev_addr)) {
150
		err = dev_uc_add(master, addr->sa_data);
151 152 153 154
		if (err < 0)
			return err;
	}

155
	if (!ether_addr_equal(dev->dev_addr, master->dev_addr))
156
		dev_uc_del(master, dev->dev_addr);
157 158

out:
Joe Perches's avatar
Joe Perches committed
159
	ether_addr_copy(dev->dev_addr, addr->sa_data);
160 161 162 163 164 165 166 167 168

	return 0;
}

static int dsa_slave_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
{
	struct dsa_slave_priv *p = netdev_priv(dev);

	if (p->phy != NULL)
169
		return phy_mii_ioctl(p->phy, ifr, cmd);
170 171 172 173

	return -EOPNOTSUPP;
}

174 175 176 177 178 179 180 181
static netdev_tx_t dsa_slave_xmit(struct sk_buff *skb, struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_switch_tree *dst = p->parent->dst;

	return dst->ops->xmit(skb, dev);
}

182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213

/* ethtool operations *******************************************************/
static int
dsa_slave_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	int err;

	err = -EOPNOTSUPP;
	if (p->phy != NULL) {
		err = phy_read_status(p->phy);
		if (err == 0)
			err = phy_ethtool_gset(p->phy, cmd);
	}

	return err;
}

static int
dsa_slave_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
{
	struct dsa_slave_priv *p = netdev_priv(dev);

	if (p->phy != NULL)
		return phy_ethtool_sset(p->phy, cmd);

	return -EOPNOTSUPP;
}

static void dsa_slave_get_drvinfo(struct net_device *dev,
				  struct ethtool_drvinfo *drvinfo)
{
214 215 216 217
	strlcpy(drvinfo->driver, "dsa", sizeof(drvinfo->driver));
	strlcpy(drvinfo->version, dsa_driver_version, sizeof(drvinfo->version));
	strlcpy(drvinfo->fw_version, "N/A", sizeof(drvinfo->fw_version));
	strlcpy(drvinfo->bus_info, "platform", sizeof(drvinfo->bus_info));
218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303
}

static int dsa_slave_nway_reset(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);

	if (p->phy != NULL)
		return genphy_restart_aneg(p->phy);

	return -EOPNOTSUPP;
}

static u32 dsa_slave_get_link(struct net_device *dev)
{
	struct dsa_slave_priv *p = netdev_priv(dev);

	if (p->phy != NULL) {
		genphy_update_link(p->phy);
		return p->phy->link;
	}

	return -EOPNOTSUPP;
}

static void dsa_slave_get_strings(struct net_device *dev,
				  uint32_t stringset, uint8_t *data)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_switch *ds = p->parent;

	if (stringset == ETH_SS_STATS) {
		int len = ETH_GSTRING_LEN;

		strncpy(data, "tx_packets", len);
		strncpy(data + len, "tx_bytes", len);
		strncpy(data + 2 * len, "rx_packets", len);
		strncpy(data + 3 * len, "rx_bytes", len);
		if (ds->drv->get_strings != NULL)
			ds->drv->get_strings(ds, p->port, data + 4 * len);
	}
}

static void dsa_slave_get_ethtool_stats(struct net_device *dev,
					struct ethtool_stats *stats,
					uint64_t *data)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_switch *ds = p->parent;

	data[0] = p->dev->stats.tx_packets;
	data[1] = p->dev->stats.tx_bytes;
	data[2] = p->dev->stats.rx_packets;
	data[3] = p->dev->stats.rx_bytes;
	if (ds->drv->get_ethtool_stats != NULL)
		ds->drv->get_ethtool_stats(ds, p->port, data + 4);
}

static int dsa_slave_get_sset_count(struct net_device *dev, int sset)
{
	struct dsa_slave_priv *p = netdev_priv(dev);
	struct dsa_switch *ds = p->parent;

	if (sset == ETH_SS_STATS) {
		int count;

		count = 4;
		if (ds->drv->get_sset_count != NULL)
			count += ds->drv->get_sset_count(ds);

		return count;
	}

	return -EOPNOTSUPP;
}

static const struct ethtool_ops dsa_slave_ethtool_ops = {
	.get_settings		= dsa_slave_get_settings,
	.set_settings		= dsa_slave_set_settings,
	.get_drvinfo		= dsa_slave_get_drvinfo,
	.nway_reset		= dsa_slave_nway_reset,
	.get_link		= dsa_slave_get_link,
	.get_strings		= dsa_slave_get_strings,
	.get_ethtool_stats	= dsa_slave_get_ethtool_stats,
	.get_sset_count		= dsa_slave_get_sset_count,
};

304
static const struct net_device_ops dsa_slave_netdev_ops = {
305
	.ndo_init		= dsa_slave_init,
306 307
	.ndo_open	 	= dsa_slave_open,
	.ndo_stop		= dsa_slave_close,
308
	.ndo_start_xmit		= dsa_slave_xmit,
309 310 311 312 313
	.ndo_change_rx_flags	= dsa_slave_change_rx_flags,
	.ndo_set_rx_mode	= dsa_slave_set_rx_mode,
	.ndo_set_mac_address	= dsa_slave_set_mac_address,
	.ndo_do_ioctl		= dsa_slave_ioctl,
};
314 315 316 317 318 319

/* slave device setup *******************************************************/
struct net_device *
dsa_slave_create(struct dsa_switch *ds, struct device *parent,
		 int port, char *name)
{
320
	struct net_device *master = ds->dst->master_netdev;
321 322 323 324
	struct net_device *slave_dev;
	struct dsa_slave_priv *p;
	int ret;

325 326
	slave_dev = alloc_netdev(sizeof(struct dsa_slave_priv), name,
				 NET_NAME_UNKNOWN, ether_setup);
327 328 329 330
	if (slave_dev == NULL)
		return slave_dev;

	slave_dev->features = master->vlan_features;
331
	slave_dev->ethtool_ops = &dsa_slave_ethtool_ops;
332
	eth_hw_addr_inherit(slave_dev, master);
333
	slave_dev->tx_queue_len = 0;
334
	slave_dev->netdev_ops = &dsa_slave_netdev_ops;
335

336
	switch (ds->dst->tag_protocol) {
337 338
#ifdef CONFIG_NET_DSA_TAG_DSA
	case htons(ETH_P_DSA):
339
		ds->dst->ops = &dsa_netdev_ops;
340 341
		break;
#endif
342 343
#ifdef CONFIG_NET_DSA_TAG_EDSA
	case htons(ETH_P_EDSA):
344
		ds->dst->ops = &edsa_netdev_ops;
345
		break;
346 347 348
#endif
#ifdef CONFIG_NET_DSA_TAG_TRAILER
	case htons(ETH_P_TRAILER):
349
		ds->dst->ops = &trailer_netdev_ops;
350
		break;
351 352 353 354
#endif
	default:
		BUG();
	}
355

356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375
	SET_NETDEV_DEV(slave_dev, parent);
	slave_dev->vlan_features = master->vlan_features;

	p = netdev_priv(slave_dev);
	p->dev = slave_dev;
	p->parent = ds;
	p->port = port;
	p->phy = ds->slave_mii_bus->phy_map[port];

	ret = register_netdev(slave_dev);
	if (ret) {
		printk(KERN_ERR "%s: error %d registering interface %s\n",
				master->name, ret, slave_dev->name);
		free_netdev(slave_dev);
		return NULL;
	}

	netif_carrier_off(slave_dev);

	if (p->phy != NULL) {
376
		phy_attach(slave_dev, dev_name(&p->phy->dev),
377
			   PHY_INTERFACE_MODE_GMII);
378 379 380 381 382 383 384 385 386 387

		p->phy->autoneg = AUTONEG_ENABLE;
		p->phy->speed = 0;
		p->phy->duplex = 0;
		p->phy->advertising = p->phy->supported | ADVERTISED_Autoneg;
		phy_start_aneg(p->phy);
	}

	return slave_dev;
}