chip.c 121.0 KB
Newer Older
1
/*
2 3
 * Marvell 88e6xxx Ethernet switch single-chip support
 *
4 5
 * Copyright (c) 2008 Marvell Semiconductor
 *
6 7 8
 * Copyright (c) 2015 CMC Electronics, Inc.
 *	Added support for VLAN Table Unit operations
 *
9 10
 * Copyright (c) 2016 Andrew Lunn <andrew@lunn.ch>
 *
V
Vivien Didelot 已提交
11 12 13
 * Copyright (c) 2016-2017 Savoir-faire Linux Inc.
 *	Vivien Didelot <vivien.didelot@savoirfairelinux.com>
 *
14 15 16 17 18 19
 * 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.
 */

20
#include <linux/delay.h>
21
#include <linux/etherdevice.h>
22
#include <linux/ethtool.h>
23
#include <linux/if_bridge.h>
24 25 26
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/irqdomain.h>
27
#include <linux/jiffies.h>
28
#include <linux/list.h>
29
#include <linux/mdio.h>
30
#include <linux/module.h>
31
#include <linux/of_device.h>
32
#include <linux/of_irq.h>
33
#include <linux/of_mdio.h>
34
#include <linux/netdevice.h>
35
#include <linux/gpio/consumer.h>
36
#include <linux/phy.h>
37
#include <net/dsa.h>
38
#include <net/switchdev.h>
39

40
#include "mv88e6xxx.h"
41
#include "global1.h"
42
#include "global2.h"
43
#include "port.h"
44

45
static void assert_reg_lock(struct mv88e6xxx_chip *chip)
46
{
47 48
	if (unlikely(!mutex_is_locked(&chip->reg_lock))) {
		dev_err(chip->dev, "Switch registers lock not held!\n");
49 50 51 52
		dump_stack();
	}
}

53 54 55 56 57 58 59 60 61 62
/* The switch ADDR[4:1] configuration pins define the chip SMI device address
 * (ADDR[0] is always zero, thus only even SMI addresses can be strapped).
 *
 * When ADDR is all zero, the chip uses Single-chip Addressing Mode, assuming it
 * is the only device connected to the SMI master. In this mode it responds to
 * all 32 possible SMI addresses, and thus maps directly the internal devices.
 *
 * When ADDR is non-zero, the chip uses Multi-chip Addressing Mode, allowing
 * multiple devices to share the SMI interface. In this mode it responds to only
 * 2 registers, used to indirectly access the internal SMI devices.
63
 */
64

65
static int mv88e6xxx_smi_read(struct mv88e6xxx_chip *chip,
66 67
			      int addr, int reg, u16 *val)
{
68
	if (!chip->smi_ops)
69 70
		return -EOPNOTSUPP;

71
	return chip->smi_ops->read(chip, addr, reg, val);
72 73
}

74
static int mv88e6xxx_smi_write(struct mv88e6xxx_chip *chip,
75 76
			       int addr, int reg, u16 val)
{
77
	if (!chip->smi_ops)
78 79
		return -EOPNOTSUPP;

80
	return chip->smi_ops->write(chip, addr, reg, val);
81 82
}

83
static int mv88e6xxx_smi_single_chip_read(struct mv88e6xxx_chip *chip,
84 85 86 87
					  int addr, int reg, u16 *val)
{
	int ret;

88
	ret = mdiobus_read_nested(chip->bus, addr, reg);
89 90 91 92 93 94 95 96
	if (ret < 0)
		return ret;

	*val = ret & 0xffff;

	return 0;
}

97
static int mv88e6xxx_smi_single_chip_write(struct mv88e6xxx_chip *chip,
98 99 100 101
					   int addr, int reg, u16 val)
{
	int ret;

102
	ret = mdiobus_write_nested(chip->bus, addr, reg, val);
103 104 105 106 107 108
	if (ret < 0)
		return ret;

	return 0;
}

109
static const struct mv88e6xxx_bus_ops mv88e6xxx_smi_single_chip_ops = {
110 111 112 113
	.read = mv88e6xxx_smi_single_chip_read,
	.write = mv88e6xxx_smi_single_chip_write,
};

114
static int mv88e6xxx_smi_multi_chip_wait(struct mv88e6xxx_chip *chip)
115 116 117 118 119
{
	int ret;
	int i;

	for (i = 0; i < 16; i++) {
120
		ret = mdiobus_read_nested(chip->bus, chip->sw_addr, SMI_CMD);
121 122 123
		if (ret < 0)
			return ret;

124
		if ((ret & SMI_CMD_BUSY) == 0)
125 126 127 128 129 130
			return 0;
	}

	return -ETIMEDOUT;
}

131
static int mv88e6xxx_smi_multi_chip_read(struct mv88e6xxx_chip *chip,
132
					 int addr, int reg, u16 *val)
133 134 135
{
	int ret;

136
	/* Wait for the bus to become free. */
137
	ret = mv88e6xxx_smi_multi_chip_wait(chip);
138 139 140
	if (ret < 0)
		return ret;

141
	/* Transmit the read command. */
142
	ret = mdiobus_write_nested(chip->bus, chip->sw_addr, SMI_CMD,
143
				   SMI_CMD_OP_22_READ | (addr << 5) | reg);
144 145 146
	if (ret < 0)
		return ret;

147
	/* Wait for the read command to complete. */
148
	ret = mv88e6xxx_smi_multi_chip_wait(chip);
149 150 151
	if (ret < 0)
		return ret;

152
	/* Read the data. */
153
	ret = mdiobus_read_nested(chip->bus, chip->sw_addr, SMI_DATA);
154 155 156
	if (ret < 0)
		return ret;

157
	*val = ret & 0xffff;
158

159
	return 0;
160 161
}

162
static int mv88e6xxx_smi_multi_chip_write(struct mv88e6xxx_chip *chip,
163
					  int addr, int reg, u16 val)
164 165 166
{
	int ret;

167
	/* Wait for the bus to become free. */
168
	ret = mv88e6xxx_smi_multi_chip_wait(chip);
169 170 171
	if (ret < 0)
		return ret;

172
	/* Transmit the data to write. */
173
	ret = mdiobus_write_nested(chip->bus, chip->sw_addr, SMI_DATA, val);
174 175 176
	if (ret < 0)
		return ret;

177
	/* Transmit the write command. */
178
	ret = mdiobus_write_nested(chip->bus, chip->sw_addr, SMI_CMD,
179
				   SMI_CMD_OP_22_WRITE | (addr << 5) | reg);
180 181 182
	if (ret < 0)
		return ret;

183
	/* Wait for the write command to complete. */
184
	ret = mv88e6xxx_smi_multi_chip_wait(chip);
185 186 187 188 189 190
	if (ret < 0)
		return ret;

	return 0;
}

191
static const struct mv88e6xxx_bus_ops mv88e6xxx_smi_multi_chip_ops = {
192 193 194 195
	.read = mv88e6xxx_smi_multi_chip_read,
	.write = mv88e6xxx_smi_multi_chip_write,
};

196
int mv88e6xxx_read(struct mv88e6xxx_chip *chip, int addr, int reg, u16 *val)
197 198 199
{
	int err;

200
	assert_reg_lock(chip);
201

202
	err = mv88e6xxx_smi_read(chip, addr, reg, val);
203 204 205
	if (err)
		return err;

206
	dev_dbg(chip->dev, "<- addr: 0x%.2x reg: 0x%.2x val: 0x%.4x\n",
207 208 209 210 211
		addr, reg, *val);

	return 0;
}

212
int mv88e6xxx_write(struct mv88e6xxx_chip *chip, int addr, int reg, u16 val)
213
{
214 215
	int err;

216
	assert_reg_lock(chip);
217

218
	err = mv88e6xxx_smi_write(chip, addr, reg, val);
219 220 221
	if (err)
		return err;

222
	dev_dbg(chip->dev, "-> addr: 0x%.2x reg: 0x%.2x val: 0x%.4x\n",
223 224
		addr, reg, val);

225 226 227
	return 0;
}

228 229 230
static int mv88e6165_phy_read(struct mv88e6xxx_chip *chip,
			      struct mii_bus *bus,
			      int addr, int reg, u16 *val)
231 232 233 234
{
	return mv88e6xxx_read(chip, addr, reg, val);
}

235 236 237
static int mv88e6165_phy_write(struct mv88e6xxx_chip *chip,
			       struct mii_bus *bus,
			       int addr, int reg, u16 val)
238 239 240 241
{
	return mv88e6xxx_write(chip, addr, reg, val);
}

242 243 244 245 246 247 248 249 250 251 252 253
static struct mii_bus *mv88e6xxx_default_mdio_bus(struct mv88e6xxx_chip *chip)
{
	struct mv88e6xxx_mdio_bus *mdio_bus;

	mdio_bus = list_first_entry(&chip->mdios, struct mv88e6xxx_mdio_bus,
				    list);
	if (!mdio_bus)
		return NULL;

	return mdio_bus->bus;
}

254 255 256 257
static int mv88e6xxx_phy_read(struct mv88e6xxx_chip *chip, int phy,
			      int reg, u16 *val)
{
	int addr = phy; /* PHY devices addresses start at 0x0 */
258
	struct mii_bus *bus;
259

260 261
	bus = mv88e6xxx_default_mdio_bus(chip);
	if (!bus)
262 263
		return -EOPNOTSUPP;

264
	if (!chip->info->ops->phy_read)
265 266 267
		return -EOPNOTSUPP;

	return chip->info->ops->phy_read(chip, bus, addr, reg, val);
268 269 270 271 272 273
}

static int mv88e6xxx_phy_write(struct mv88e6xxx_chip *chip, int phy,
			       int reg, u16 val)
{
	int addr = phy; /* PHY devices addresses start at 0x0 */
274
	struct mii_bus *bus;
275

276 277
	bus = mv88e6xxx_default_mdio_bus(chip);
	if (!bus)
278 279
		return -EOPNOTSUPP;

280
	if (!chip->info->ops->phy_write)
281 282 283
		return -EOPNOTSUPP;

	return chip->info->ops->phy_write(chip, bus, addr, reg, val);
284 285
}

286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353
static int mv88e6xxx_phy_page_get(struct mv88e6xxx_chip *chip, int phy, u8 page)
{
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_PHY_PAGE))
		return -EOPNOTSUPP;

	return mv88e6xxx_phy_write(chip, phy, PHY_PAGE, page);
}

static void mv88e6xxx_phy_page_put(struct mv88e6xxx_chip *chip, int phy)
{
	int err;

	/* Restore PHY page Copper 0x0 for access via the registered MDIO bus */
	err = mv88e6xxx_phy_write(chip, phy, PHY_PAGE, PHY_PAGE_COPPER);
	if (unlikely(err)) {
		dev_err(chip->dev, "failed to restore PHY %d page Copper (%d)\n",
			phy, err);
	}
}

static int mv88e6xxx_phy_page_read(struct mv88e6xxx_chip *chip, int phy,
				   u8 page, int reg, u16 *val)
{
	int err;

	/* There is no paging for registers 22 */
	if (reg == PHY_PAGE)
		return -EINVAL;

	err = mv88e6xxx_phy_page_get(chip, phy, page);
	if (!err) {
		err = mv88e6xxx_phy_read(chip, phy, reg, val);
		mv88e6xxx_phy_page_put(chip, phy);
	}

	return err;
}

static int mv88e6xxx_phy_page_write(struct mv88e6xxx_chip *chip, int phy,
				    u8 page, int reg, u16 val)
{
	int err;

	/* There is no paging for registers 22 */
	if (reg == PHY_PAGE)
		return -EINVAL;

	err = mv88e6xxx_phy_page_get(chip, phy, page);
	if (!err) {
		err = mv88e6xxx_phy_write(chip, phy, PHY_PAGE, page);
		mv88e6xxx_phy_page_put(chip, phy);
	}

	return err;
}

static int mv88e6xxx_serdes_read(struct mv88e6xxx_chip *chip, int reg, u16 *val)
{
	return mv88e6xxx_phy_page_read(chip, ADDR_SERDES, SERDES_PAGE_FIBER,
				       reg, val);
}

static int mv88e6xxx_serdes_write(struct mv88e6xxx_chip *chip, int reg, u16 val)
{
	return mv88e6xxx_phy_page_write(chip, ADDR_SERDES, SERDES_PAGE_FIBER,
					reg, val);
}

354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454
static void mv88e6xxx_g1_irq_mask(struct irq_data *d)
{
	struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
	unsigned int n = d->hwirq;

	chip->g1_irq.masked |= (1 << n);
}

static void mv88e6xxx_g1_irq_unmask(struct irq_data *d)
{
	struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
	unsigned int n = d->hwirq;

	chip->g1_irq.masked &= ~(1 << n);
}

static irqreturn_t mv88e6xxx_g1_irq_thread_fn(int irq, void *dev_id)
{
	struct mv88e6xxx_chip *chip = dev_id;
	unsigned int nhandled = 0;
	unsigned int sub_irq;
	unsigned int n;
	u16 reg;
	int err;

	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_g1_read(chip, GLOBAL_STATUS, &reg);
	mutex_unlock(&chip->reg_lock);

	if (err)
		goto out;

	for (n = 0; n < chip->g1_irq.nirqs; ++n) {
		if (reg & (1 << n)) {
			sub_irq = irq_find_mapping(chip->g1_irq.domain, n);
			handle_nested_irq(sub_irq);
			++nhandled;
		}
	}
out:
	return (nhandled > 0 ? IRQ_HANDLED : IRQ_NONE);
}

static void mv88e6xxx_g1_irq_bus_lock(struct irq_data *d)
{
	struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);

	mutex_lock(&chip->reg_lock);
}

static void mv88e6xxx_g1_irq_bus_sync_unlock(struct irq_data *d)
{
	struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
	u16 mask = GENMASK(chip->g1_irq.nirqs, 0);
	u16 reg;
	int err;

	err = mv88e6xxx_g1_read(chip, GLOBAL_CONTROL, &reg);
	if (err)
		goto out;

	reg &= ~mask;
	reg |= (~chip->g1_irq.masked & mask);

	err = mv88e6xxx_g1_write(chip, GLOBAL_CONTROL, reg);
	if (err)
		goto out;

out:
	mutex_unlock(&chip->reg_lock);
}

static struct irq_chip mv88e6xxx_g1_irq_chip = {
	.name			= "mv88e6xxx-g1",
	.irq_mask		= mv88e6xxx_g1_irq_mask,
	.irq_unmask		= mv88e6xxx_g1_irq_unmask,
	.irq_bus_lock		= mv88e6xxx_g1_irq_bus_lock,
	.irq_bus_sync_unlock	= mv88e6xxx_g1_irq_bus_sync_unlock,
};

static int mv88e6xxx_g1_irq_domain_map(struct irq_domain *d,
				       unsigned int irq,
				       irq_hw_number_t hwirq)
{
	struct mv88e6xxx_chip *chip = d->host_data;

	irq_set_chip_data(irq, d->host_data);
	irq_set_chip_and_handler(irq, &chip->g1_irq.chip, handle_level_irq);
	irq_set_noprobe(irq);

	return 0;
}

static const struct irq_domain_ops mv88e6xxx_g1_irq_domain_ops = {
	.map	= mv88e6xxx_g1_irq_domain_map,
	.xlate	= irq_domain_xlate_twocell,
};

static void mv88e6xxx_g1_irq_free(struct mv88e6xxx_chip *chip)
{
	int irq, virq;
455 456 457 458 459 460 461
	u16 mask;

	mv88e6xxx_g1_read(chip, GLOBAL_CONTROL, &mask);
	mask |= GENMASK(chip->g1_irq.nirqs, 0);
	mv88e6xxx_g1_write(chip, GLOBAL_CONTROL, mask);

	free_irq(chip->irq, chip);
462

463
	for (irq = 0; irq < chip->g1_irq.nirqs; irq++) {
464
		virq = irq_find_mapping(chip->g1_irq.domain, irq);
465 466 467
		irq_dispose_mapping(virq);
	}

468
	irq_domain_remove(chip->g1_irq.domain);
469 470 471 472
}

static int mv88e6xxx_g1_irq_setup(struct mv88e6xxx_chip *chip)
{
473 474
	int err, irq, virq;
	u16 reg, mask;
475 476 477 478 479 480 481 482 483 484 485 486 487 488

	chip->g1_irq.nirqs = chip->info->g1_irqs;
	chip->g1_irq.domain = irq_domain_add_simple(
		NULL, chip->g1_irq.nirqs, 0,
		&mv88e6xxx_g1_irq_domain_ops, chip);
	if (!chip->g1_irq.domain)
		return -ENOMEM;

	for (irq = 0; irq < chip->g1_irq.nirqs; irq++)
		irq_create_mapping(chip->g1_irq.domain, irq);

	chip->g1_irq.chip = mv88e6xxx_g1_irq_chip;
	chip->g1_irq.masked = ~0;

489
	err = mv88e6xxx_g1_read(chip, GLOBAL_CONTROL, &mask);
490
	if (err)
491
		goto out_mapping;
492

493
	mask &= ~GENMASK(chip->g1_irq.nirqs, 0);
494

495
	err = mv88e6xxx_g1_write(chip, GLOBAL_CONTROL, mask);
496
	if (err)
497
		goto out_disable;
498 499 500 501

	/* Reading the interrupt status clears (most of) them */
	err = mv88e6xxx_g1_read(chip, GLOBAL_STATUS, &reg);
	if (err)
502
		goto out_disable;
503 504 505 506 507 508

	err = request_threaded_irq(chip->irq, NULL,
				   mv88e6xxx_g1_irq_thread_fn,
				   IRQF_ONESHOT | IRQF_TRIGGER_FALLING,
				   dev_name(chip->dev), chip);
	if (err)
509
		goto out_disable;
510 511 512

	return 0;

513 514 515 516 517 518 519 520 521 522 523
out_disable:
	mask |= GENMASK(chip->g1_irq.nirqs, 0);
	mv88e6xxx_g1_write(chip, GLOBAL_CONTROL, mask);

out_mapping:
	for (irq = 0; irq < 16; irq++) {
		virq = irq_find_mapping(chip->g1_irq.domain, irq);
		irq_dispose_mapping(virq);
	}

	irq_domain_remove(chip->g1_irq.domain);
524 525 526 527

	return err;
}

528
int mv88e6xxx_wait(struct mv88e6xxx_chip *chip, int addr, int reg, u16 mask)
529
{
530
	int i;
531

532
	for (i = 0; i < 16; i++) {
533 534 535 536 537 538 539 540 541 542 543 544 545
		u16 val;
		int err;

		err = mv88e6xxx_read(chip, addr, reg, &val);
		if (err)
			return err;

		if (!(val & mask))
			return 0;

		usleep_range(1000, 2000);
	}

546
	dev_err(chip->dev, "Timeout while waiting for switch\n");
547 548 549
	return -ETIMEDOUT;
}

550
/* Indirect write to single pointer-data register with an Update bit */
551
int mv88e6xxx_update(struct mv88e6xxx_chip *chip, int addr, int reg, u16 update)
552 553
{
	u16 val;
554
	int err;
555 556

	/* Wait until the previous operation is completed */
557 558 559
	err = mv88e6xxx_wait(chip, addr, reg, BIT(15));
	if (err)
		return err;
560 561 562 563 564 565 566

	/* Set the Update bit to trigger a write operation */
	val = BIT(15) | update;

	return mv88e6xxx_write(chip, addr, reg, val);
}

567
static int mv88e6xxx_ppu_disable(struct mv88e6xxx_chip *chip)
568
{
569 570
	if (!chip->info->ops->ppu_disable)
		return 0;
571

572
	return chip->info->ops->ppu_disable(chip);
573 574
}

575
static int mv88e6xxx_ppu_enable(struct mv88e6xxx_chip *chip)
576
{
577 578
	if (!chip->info->ops->ppu_enable)
		return 0;
579

580
	return chip->info->ops->ppu_enable(chip);
581 582 583 584
}

static void mv88e6xxx_ppu_reenable_work(struct work_struct *ugly)
{
585
	struct mv88e6xxx_chip *chip;
586

587
	chip = container_of(ugly, struct mv88e6xxx_chip, ppu_work);
588

589
	mutex_lock(&chip->reg_lock);
590

591 592 593 594
	if (mutex_trylock(&chip->ppu_mutex)) {
		if (mv88e6xxx_ppu_enable(chip) == 0)
			chip->ppu_disabled = 0;
		mutex_unlock(&chip->ppu_mutex);
595
	}
596

597
	mutex_unlock(&chip->reg_lock);
598 599 600 601
}

static void mv88e6xxx_ppu_reenable_timer(unsigned long _ps)
{
602
	struct mv88e6xxx_chip *chip = (void *)_ps;
603

604
	schedule_work(&chip->ppu_work);
605 606
}

607
static int mv88e6xxx_ppu_access_get(struct mv88e6xxx_chip *chip)
608 609 610
{
	int ret;

611
	mutex_lock(&chip->ppu_mutex);
612

613
	/* If the PHY polling unit is enabled, disable it so that
614 615 616 617
	 * we can access the PHY registers.  If it was already
	 * disabled, cancel the timer that is going to re-enable
	 * it.
	 */
618 619
	if (!chip->ppu_disabled) {
		ret = mv88e6xxx_ppu_disable(chip);
620
		if (ret < 0) {
621
			mutex_unlock(&chip->ppu_mutex);
622 623
			return ret;
		}
624
		chip->ppu_disabled = 1;
625
	} else {
626
		del_timer(&chip->ppu_timer);
627
		ret = 0;
628 629 630 631 632
	}

	return ret;
}

633
static void mv88e6xxx_ppu_access_put(struct mv88e6xxx_chip *chip)
634
{
635
	/* Schedule a timer to re-enable the PHY polling unit. */
636 637
	mod_timer(&chip->ppu_timer, jiffies + msecs_to_jiffies(10));
	mutex_unlock(&chip->ppu_mutex);
638 639
}

640
static void mv88e6xxx_ppu_state_init(struct mv88e6xxx_chip *chip)
641
{
642 643
	mutex_init(&chip->ppu_mutex);
	INIT_WORK(&chip->ppu_work, mv88e6xxx_ppu_reenable_work);
644 645
	setup_timer(&chip->ppu_timer, mv88e6xxx_ppu_reenable_timer,
		    (unsigned long)chip);
646 647
}

648 649 650 651 652
static void mv88e6xxx_ppu_state_destroy(struct mv88e6xxx_chip *chip)
{
	del_timer_sync(&chip->ppu_timer);
}

653 654 655
static int mv88e6xxx_phy_ppu_read(struct mv88e6xxx_chip *chip,
				  struct mii_bus *bus,
				  int addr, int reg, u16 *val)
656
{
657
	int err;
658

659 660 661
	err = mv88e6xxx_ppu_access_get(chip);
	if (!err) {
		err = mv88e6xxx_read(chip, addr, reg, val);
662
		mv88e6xxx_ppu_access_put(chip);
663 664
	}

665
	return err;
666 667
}

668 669 670
static int mv88e6xxx_phy_ppu_write(struct mv88e6xxx_chip *chip,
				   struct mii_bus *bus,
				   int addr, int reg, u16 val)
671
{
672
	int err;
673

674 675 676
	err = mv88e6xxx_ppu_access_get(chip);
	if (!err) {
		err = mv88e6xxx_write(chip, addr, reg, val);
677
		mv88e6xxx_ppu_access_put(chip);
678 679
	}

680
	return err;
681 682
}

683
static bool mv88e6xxx_6097_family(struct mv88e6xxx_chip *chip)
684
{
685
	return chip->info->family == MV88E6XXX_FAMILY_6097;
686 687
}

688
static bool mv88e6xxx_6165_family(struct mv88e6xxx_chip *chip)
689
{
690
	return chip->info->family == MV88E6XXX_FAMILY_6165;
691 692
}

693 694 695 696 697
static bool mv88e6xxx_6341_family(struct mv88e6xxx_chip *chip)
{
	return chip->info->family == MV88E6XXX_FAMILY_6341;
}

698
static bool mv88e6xxx_6351_family(struct mv88e6xxx_chip *chip)
699
{
700
	return chip->info->family == MV88E6XXX_FAMILY_6351;
701 702
}

703
static bool mv88e6xxx_6352_family(struct mv88e6xxx_chip *chip)
704
{
705
	return chip->info->family == MV88E6XXX_FAMILY_6352;
706 707
}

708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739
static int mv88e6xxx_port_setup_mac(struct mv88e6xxx_chip *chip, int port,
				    int link, int speed, int duplex,
				    phy_interface_t mode)
{
	int err;

	if (!chip->info->ops->port_set_link)
		return 0;

	/* Port's MAC control must not be changed unless the link is down */
	err = chip->info->ops->port_set_link(chip, port, 0);
	if (err)
		return err;

	if (chip->info->ops->port_set_speed) {
		err = chip->info->ops->port_set_speed(chip, port, speed);
		if (err && err != -EOPNOTSUPP)
			goto restore_link;
	}

	if (chip->info->ops->port_set_duplex) {
		err = chip->info->ops->port_set_duplex(chip, port, duplex);
		if (err && err != -EOPNOTSUPP)
			goto restore_link;
	}

	if (chip->info->ops->port_set_rgmii_delay) {
		err = chip->info->ops->port_set_rgmii_delay(chip, port, mode);
		if (err && err != -EOPNOTSUPP)
			goto restore_link;
	}

740 741 742 743 744 745
	if (chip->info->ops->port_set_cmode) {
		err = chip->info->ops->port_set_cmode(chip, port, mode);
		if (err && err != -EOPNOTSUPP)
			goto restore_link;
	}

746 747 748 749 750 751 752 753 754
	err = 0;
restore_link:
	if (chip->info->ops->port_set_link(chip, port, link))
		netdev_err(chip->ds->ports[port].netdev,
			   "failed to restore MAC's link\n");

	return err;
}

755 756 757 758
/* We expect the switch to perform auto negotiation if there is a real
 * phy. However, in the case of a fixed link phy, we force the port
 * settings from the fixed link settings.
 */
759 760
static void mv88e6xxx_adjust_link(struct dsa_switch *ds, int port,
				  struct phy_device *phydev)
761
{
V
Vivien Didelot 已提交
762
	struct mv88e6xxx_chip *chip = ds->priv;
763
	int err;
764 765 766 767

	if (!phy_is_pseudo_fixed_link(phydev))
		return;

768
	mutex_lock(&chip->reg_lock);
769 770
	err = mv88e6xxx_port_setup_mac(chip, port, phydev->link, phydev->speed,
				       phydev->duplex, phydev->interface);
771
	mutex_unlock(&chip->reg_lock);
772 773 774

	if (err && err != -EOPNOTSUPP)
		netdev_err(ds->ports[port].netdev, "failed to configure MAC\n");
775 776
}

777
static int mv88e6xxx_stats_snapshot(struct mv88e6xxx_chip *chip, int port)
778
{
779 780
	if (!chip->info->ops->stats_snapshot)
		return -EOPNOTSUPP;
781

782
	return chip->info->ops->stats_snapshot(chip, port);
783 784
}

785
static struct mv88e6xxx_hw_stat mv88e6xxx_hw_stats[] = {
786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844
	{ "in_good_octets",		8, 0x00, STATS_TYPE_BANK0, },
	{ "in_bad_octets",		4, 0x02, STATS_TYPE_BANK0, },
	{ "in_unicast",			4, 0x04, STATS_TYPE_BANK0, },
	{ "in_broadcasts",		4, 0x06, STATS_TYPE_BANK0, },
	{ "in_multicasts",		4, 0x07, STATS_TYPE_BANK0, },
	{ "in_pause",			4, 0x16, STATS_TYPE_BANK0, },
	{ "in_undersize",		4, 0x18, STATS_TYPE_BANK0, },
	{ "in_fragments",		4, 0x19, STATS_TYPE_BANK0, },
	{ "in_oversize",		4, 0x1a, STATS_TYPE_BANK0, },
	{ "in_jabber",			4, 0x1b, STATS_TYPE_BANK0, },
	{ "in_rx_error",		4, 0x1c, STATS_TYPE_BANK0, },
	{ "in_fcs_error",		4, 0x1d, STATS_TYPE_BANK0, },
	{ "out_octets",			8, 0x0e, STATS_TYPE_BANK0, },
	{ "out_unicast",		4, 0x10, STATS_TYPE_BANK0, },
	{ "out_broadcasts",		4, 0x13, STATS_TYPE_BANK0, },
	{ "out_multicasts",		4, 0x12, STATS_TYPE_BANK0, },
	{ "out_pause",			4, 0x15, STATS_TYPE_BANK0, },
	{ "excessive",			4, 0x11, STATS_TYPE_BANK0, },
	{ "collisions",			4, 0x1e, STATS_TYPE_BANK0, },
	{ "deferred",			4, 0x05, STATS_TYPE_BANK0, },
	{ "single",			4, 0x14, STATS_TYPE_BANK0, },
	{ "multiple",			4, 0x17, STATS_TYPE_BANK0, },
	{ "out_fcs_error",		4, 0x03, STATS_TYPE_BANK0, },
	{ "late",			4, 0x1f, STATS_TYPE_BANK0, },
	{ "hist_64bytes",		4, 0x08, STATS_TYPE_BANK0, },
	{ "hist_65_127bytes",		4, 0x09, STATS_TYPE_BANK0, },
	{ "hist_128_255bytes",		4, 0x0a, STATS_TYPE_BANK0, },
	{ "hist_256_511bytes",		4, 0x0b, STATS_TYPE_BANK0, },
	{ "hist_512_1023bytes",		4, 0x0c, STATS_TYPE_BANK0, },
	{ "hist_1024_max_bytes",	4, 0x0d, STATS_TYPE_BANK0, },
	{ "sw_in_discards",		4, 0x10, STATS_TYPE_PORT, },
	{ "sw_in_filtered",		2, 0x12, STATS_TYPE_PORT, },
	{ "sw_out_filtered",		2, 0x13, STATS_TYPE_PORT, },
	{ "in_discards",		4, 0x00, STATS_TYPE_BANK1, },
	{ "in_filtered",		4, 0x01, STATS_TYPE_BANK1, },
	{ "in_accepted",		4, 0x02, STATS_TYPE_BANK1, },
	{ "in_bad_accepted",		4, 0x03, STATS_TYPE_BANK1, },
	{ "in_good_avb_class_a",	4, 0x04, STATS_TYPE_BANK1, },
	{ "in_good_avb_class_b",	4, 0x05, STATS_TYPE_BANK1, },
	{ "in_bad_avb_class_a",		4, 0x06, STATS_TYPE_BANK1, },
	{ "in_bad_avb_class_b",		4, 0x07, STATS_TYPE_BANK1, },
	{ "tcam_counter_0",		4, 0x08, STATS_TYPE_BANK1, },
	{ "tcam_counter_1",		4, 0x09, STATS_TYPE_BANK1, },
	{ "tcam_counter_2",		4, 0x0a, STATS_TYPE_BANK1, },
	{ "tcam_counter_3",		4, 0x0b, STATS_TYPE_BANK1, },
	{ "in_da_unknown",		4, 0x0e, STATS_TYPE_BANK1, },
	{ "in_management",		4, 0x0f, STATS_TYPE_BANK1, },
	{ "out_queue_0",		4, 0x10, STATS_TYPE_BANK1, },
	{ "out_queue_1",		4, 0x11, STATS_TYPE_BANK1, },
	{ "out_queue_2",		4, 0x12, STATS_TYPE_BANK1, },
	{ "out_queue_3",		4, 0x13, STATS_TYPE_BANK1, },
	{ "out_queue_4",		4, 0x14, STATS_TYPE_BANK1, },
	{ "out_queue_5",		4, 0x15, STATS_TYPE_BANK1, },
	{ "out_queue_6",		4, 0x16, STATS_TYPE_BANK1, },
	{ "out_queue_7",		4, 0x17, STATS_TYPE_BANK1, },
	{ "out_cut_through",		4, 0x18, STATS_TYPE_BANK1, },
	{ "out_octets_a",		4, 0x1a, STATS_TYPE_BANK1, },
	{ "out_octets_b",		4, 0x1b, STATS_TYPE_BANK1, },
	{ "out_management",		4, 0x1f, STATS_TYPE_BANK1, },
845 846
};

847
static uint64_t _mv88e6xxx_get_ethtool_stat(struct mv88e6xxx_chip *chip,
848
					    struct mv88e6xxx_hw_stat *s,
849 850
					    int port, u16 bank1_select,
					    u16 histogram)
851 852 853
{
	u32 low;
	u32 high = 0;
854
	u16 reg = 0;
855
	int err;
856 857
	u64 value;

858
	switch (s->type) {
859
	case STATS_TYPE_PORT:
860 861
		err = mv88e6xxx_port_read(chip, port, s->reg, &reg);
		if (err)
862 863
			return UINT64_MAX;

864
		low = reg;
865
		if (s->sizeof_stat == 4) {
866 867
			err = mv88e6xxx_port_read(chip, port, s->reg + 1, &reg);
			if (err)
868
				return UINT64_MAX;
869
			high = reg;
870
		}
871
		break;
872
	case STATS_TYPE_BANK1:
873
		reg = bank1_select;
874 875
		/* fall through */
	case STATS_TYPE_BANK0:
876
		reg |= s->reg | histogram;
877
		mv88e6xxx_g1_stats_read(chip, reg, &low);
878
		if (s->sizeof_stat == 8)
879
			mv88e6xxx_g1_stats_read(chip, reg + 1, &high);
880 881 882 883 884
	}
	value = (((u64)high) << 16) | low;
	return value;
}

885 886
static void mv88e6xxx_stats_get_strings(struct mv88e6xxx_chip *chip,
					uint8_t *data, int types)
887
{
888 889
	struct mv88e6xxx_hw_stat *stat;
	int i, j;
890

891 892
	for (i = 0, j = 0; i < ARRAY_SIZE(mv88e6xxx_hw_stats); i++) {
		stat = &mv88e6xxx_hw_stats[i];
893
		if (stat->type & types) {
894 895 896 897
			memcpy(data + j * ETH_GSTRING_LEN, stat->string,
			       ETH_GSTRING_LEN);
			j++;
		}
898
	}
899 900
}

901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916
static void mv88e6095_stats_get_strings(struct mv88e6xxx_chip *chip,
					uint8_t *data)
{
	mv88e6xxx_stats_get_strings(chip, data,
				    STATS_TYPE_BANK0 | STATS_TYPE_PORT);
}

static void mv88e6320_stats_get_strings(struct mv88e6xxx_chip *chip,
					uint8_t *data)
{
	mv88e6xxx_stats_get_strings(chip, data,
				    STATS_TYPE_BANK0 | STATS_TYPE_BANK1);
}

static void mv88e6xxx_get_strings(struct dsa_switch *ds, int port,
				  uint8_t *data)
917
{
V
Vivien Didelot 已提交
918
	struct mv88e6xxx_chip *chip = ds->priv;
919 920 921 922 923 924 925 926

	if (chip->info->ops->stats_get_strings)
		chip->info->ops->stats_get_strings(chip, data);
}

static int mv88e6xxx_stats_get_sset_count(struct mv88e6xxx_chip *chip,
					  int types)
{
927 928 929 930 931
	struct mv88e6xxx_hw_stat *stat;
	int i, j;

	for (i = 0, j = 0; i < ARRAY_SIZE(mv88e6xxx_hw_stats); i++) {
		stat = &mv88e6xxx_hw_stats[i];
932
		if (stat->type & types)
933 934 935
			j++;
	}
	return j;
936 937
}

938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959
static int mv88e6095_stats_get_sset_count(struct mv88e6xxx_chip *chip)
{
	return mv88e6xxx_stats_get_sset_count(chip, STATS_TYPE_BANK0 |
					      STATS_TYPE_PORT);
}

static int mv88e6320_stats_get_sset_count(struct mv88e6xxx_chip *chip)
{
	return mv88e6xxx_stats_get_sset_count(chip, STATS_TYPE_BANK0 |
					      STATS_TYPE_BANK1);
}

static int mv88e6xxx_get_sset_count(struct dsa_switch *ds)
{
	struct mv88e6xxx_chip *chip = ds->priv;

	if (chip->info->ops->stats_get_sset_count)
		return chip->info->ops->stats_get_sset_count(chip);

	return 0;
}

960
static void mv88e6xxx_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
961 962
				      uint64_t *data, int types,
				      u16 bank1_select, u16 histogram)
963 964 965 966 967 968 969
{
	struct mv88e6xxx_hw_stat *stat;
	int i, j;

	for (i = 0, j = 0; i < ARRAY_SIZE(mv88e6xxx_hw_stats); i++) {
		stat = &mv88e6xxx_hw_stats[i];
		if (stat->type & types) {
970 971 972
			data[j] = _mv88e6xxx_get_ethtool_stat(chip, stat, port,
							      bank1_select,
							      histogram);
973 974 975 976 977 978 979 980 981
			j++;
		}
	}
}

static void mv88e6095_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
				      uint64_t *data)
{
	return mv88e6xxx_stats_get_stats(chip, port, data,
982 983
					 STATS_TYPE_BANK0 | STATS_TYPE_PORT,
					 0, GLOBAL_STATS_OP_HIST_RX_TX);
984 985 986 987 988 989
}

static void mv88e6320_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
				      uint64_t *data)
{
	return mv88e6xxx_stats_get_stats(chip, port, data,
990 991 992 993 994 995 996 997 998 999 1000
					 STATS_TYPE_BANK0 | STATS_TYPE_BANK1,
					 GLOBAL_STATS_OP_BANK_1_BIT_9,
					 GLOBAL_STATS_OP_HIST_RX_TX);
}

static void mv88e6390_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
				      uint64_t *data)
{
	return mv88e6xxx_stats_get_stats(chip, port, data,
					 STATS_TYPE_BANK0 | STATS_TYPE_BANK1,
					 GLOBAL_STATS_OP_BANK_1_BIT_10, 0);
1001 1002 1003 1004 1005 1006 1007 1008 1009
}

static void mv88e6xxx_get_stats(struct mv88e6xxx_chip *chip, int port,
				uint64_t *data)
{
	if (chip->info->ops->stats_get_stats)
		chip->info->ops->stats_get_stats(chip, port, data);
}

1010 1011
static void mv88e6xxx_get_ethtool_stats(struct dsa_switch *ds, int port,
					uint64_t *data)
1012
{
V
Vivien Didelot 已提交
1013
	struct mv88e6xxx_chip *chip = ds->priv;
1014 1015
	int ret;

1016
	mutex_lock(&chip->reg_lock);
1017

1018
	ret = mv88e6xxx_stats_snapshot(chip, port);
1019
	if (ret < 0) {
1020
		mutex_unlock(&chip->reg_lock);
1021 1022
		return;
	}
1023 1024

	mv88e6xxx_get_stats(chip, port, data);
1025

1026
	mutex_unlock(&chip->reg_lock);
1027 1028
}

1029 1030 1031 1032 1033 1034 1035 1036
static int mv88e6xxx_stats_set_histogram(struct mv88e6xxx_chip *chip)
{
	if (chip->info->ops->stats_set_histogram)
		return chip->info->ops->stats_set_histogram(chip);

	return 0;
}

1037
static int mv88e6xxx_get_regs_len(struct dsa_switch *ds, int port)
1038 1039 1040 1041
{
	return 32 * sizeof(u16);
}

1042 1043
static void mv88e6xxx_get_regs(struct dsa_switch *ds, int port,
			       struct ethtool_regs *regs, void *_p)
1044
{
V
Vivien Didelot 已提交
1045
	struct mv88e6xxx_chip *chip = ds->priv;
1046 1047
	int err;
	u16 reg;
1048 1049 1050 1051 1052 1053 1054
	u16 *p = _p;
	int i;

	regs->version = 0;

	memset(p, 0xff, 32 * sizeof(u16));

1055
	mutex_lock(&chip->reg_lock);
1056

1057 1058
	for (i = 0; i < 32; i++) {

1059 1060 1061
		err = mv88e6xxx_port_read(chip, port, i, &reg);
		if (!err)
			p[i] = reg;
1062
	}
1063

1064
	mutex_unlock(&chip->reg_lock);
1065 1066
}

1067 1068
static int mv88e6xxx_get_eee(struct dsa_switch *ds, int port,
			     struct ethtool_eee *e)
1069
{
V
Vivien Didelot 已提交
1070
	struct mv88e6xxx_chip *chip = ds->priv;
1071 1072
	u16 reg;
	int err;
1073

1074
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_EEE))
1075 1076
		return -EOPNOTSUPP;

1077
	mutex_lock(&chip->reg_lock);
1078

1079 1080
	err = mv88e6xxx_phy_read(chip, port, 16, &reg);
	if (err)
1081
		goto out;
1082 1083 1084 1085

	e->eee_enabled = !!(reg & 0x0200);
	e->tx_lpi_enabled = !!(reg & 0x0100);

1086
	err = mv88e6xxx_port_read(chip, port, PORT_STATUS, &reg);
1087
	if (err)
1088
		goto out;
1089

1090
	e->eee_active = !!(reg & PORT_STATUS_EEE);
1091
out:
1092
	mutex_unlock(&chip->reg_lock);
1093 1094

	return err;
1095 1096
}

1097 1098
static int mv88e6xxx_set_eee(struct dsa_switch *ds, int port,
			     struct phy_device *phydev, struct ethtool_eee *e)
1099
{
V
Vivien Didelot 已提交
1100
	struct mv88e6xxx_chip *chip = ds->priv;
1101 1102
	u16 reg;
	int err;
1103

1104
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_EEE))
1105 1106
		return -EOPNOTSUPP;

1107
	mutex_lock(&chip->reg_lock);
1108

1109 1110
	err = mv88e6xxx_phy_read(chip, port, 16, &reg);
	if (err)
1111 1112
		goto out;

1113
	reg &= ~0x0300;
1114 1115 1116 1117 1118
	if (e->eee_enabled)
		reg |= 0x0200;
	if (e->tx_lpi_enabled)
		reg |= 0x0100;

1119
	err = mv88e6xxx_phy_write(chip, port, 16, reg);
1120
out:
1121
	mutex_unlock(&chip->reg_lock);
1122

1123
	return err;
1124 1125
}

1126
static int _mv88e6xxx_port_based_vlan_map(struct mv88e6xxx_chip *chip, int port)
1127
{
1128
	struct dsa_switch *ds = chip->ds;
1129
	struct net_device *bridge = ds->ports[port].bridge_dev;
1130 1131 1132 1133 1134
	u16 output_ports = 0;
	int i;

	/* allow CPU port or DSA link(s) to send frames to every port */
	if (dsa_is_cpu_port(ds, port) || dsa_is_dsa_port(ds, port)) {
1135
		output_ports = ~0;
1136
	} else {
1137
		for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1138
			/* allow sending frames to every group member */
1139
			if (bridge && ds->ports[i].bridge_dev == bridge)
1140 1141 1142 1143 1144 1145 1146 1147 1148 1149
				output_ports |= BIT(i);

			/* allow sending frames to CPU port and DSA link(s) */
			if (dsa_is_cpu_port(ds, i) || dsa_is_dsa_port(ds, i))
				output_ports |= BIT(i);
		}
	}

	/* prevent frames from going back out of the port they came in on */
	output_ports &= ~BIT(port);
1150

1151
	return mv88e6xxx_port_set_vlan_map(chip, port, output_ports);
1152 1153
}

1154 1155
static void mv88e6xxx_port_stp_state_set(struct dsa_switch *ds, int port,
					 u8 state)
1156
{
V
Vivien Didelot 已提交
1157
	struct mv88e6xxx_chip *chip = ds->priv;
1158
	int stp_state;
1159
	int err;
1160 1161 1162

	switch (state) {
	case BR_STATE_DISABLED:
1163
		stp_state = PORT_CONTROL_STATE_DISABLED;
1164 1165 1166
		break;
	case BR_STATE_BLOCKING:
	case BR_STATE_LISTENING:
1167
		stp_state = PORT_CONTROL_STATE_BLOCKING;
1168 1169
		break;
	case BR_STATE_LEARNING:
1170
		stp_state = PORT_CONTROL_STATE_LEARNING;
1171 1172 1173
		break;
	case BR_STATE_FORWARDING:
	default:
1174
		stp_state = PORT_CONTROL_STATE_FORWARDING;
1175 1176 1177
		break;
	}

1178
	mutex_lock(&chip->reg_lock);
1179
	err = mv88e6xxx_port_set_state(chip, port, stp_state);
1180
	mutex_unlock(&chip->reg_lock);
1181 1182

	if (err)
1183
		netdev_err(ds->ports[port].netdev, "failed to update state\n");
1184 1185
}

1186 1187
static int mv88e6xxx_atu_setup(struct mv88e6xxx_chip *chip)
{
1188 1189
	int err;

1190 1191 1192 1193
	err = mv88e6xxx_g1_atu_flush(chip, 0, true);
	if (err)
		return err;

1194 1195 1196 1197
	err = mv88e6xxx_g1_atu_set_learn2all(chip, true);
	if (err)
		return err;

1198 1199 1200
	return mv88e6xxx_g1_atu_set_age_time(chip, 300000);
}

1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214
static int mv88e6xxx_pvt_map(struct mv88e6xxx_chip *chip, int dev, int port)
{
	u16 pvlan = 0;

	if (!mv88e6xxx_has_pvt(chip))
		return -EOPNOTSUPP;

	/* Skip the local source device, which uses in-chip port VLAN */
	if (dev != chip->ds->index)
		pvlan = mv88e6xxx_port_mask(chip);

	return mv88e6xxx_g2_pvt_write(chip, dev, port, pvlan);
}

1215 1216
static int mv88e6xxx_pvt_setup(struct mv88e6xxx_chip *chip)
{
1217 1218 1219
	int dev, port;
	int err;

1220 1221 1222 1223 1224 1225
	if (!mv88e6xxx_has_pvt(chip))
		return 0;

	/* Clear 5 Bit Port for usage with Marvell Link Street devices:
	 * use 4 bits for the Src_Port/Src_Trunk and 5 bits for the Src_Dev.
	 */
1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238
	err = mv88e6xxx_g2_misc_4_bit_port(chip);
	if (err)
		return err;

	for (dev = 0; dev < MV88E6XXX_MAX_PVT_SWITCHES; ++dev) {
		for (port = 0; port < MV88E6XXX_MAX_PVT_PORTS; ++port) {
			err = mv88e6xxx_pvt_map(chip, dev, port);
			if (err)
				return err;
		}
	}

	return 0;
1239 1240
}

1241 1242 1243 1244 1245 1246
static void mv88e6xxx_port_fast_age(struct dsa_switch *ds, int port)
{
	struct mv88e6xxx_chip *chip = ds->priv;
	int err;

	mutex_lock(&chip->reg_lock);
1247
	err = mv88e6xxx_g1_atu_remove(chip, 0, port, false);
1248 1249 1250 1251 1252 1253
	mutex_unlock(&chip->reg_lock);

	if (err)
		netdev_err(ds->ports[port].netdev, "failed to flush ATU\n");
}

1254
static int _mv88e6xxx_vtu_wait(struct mv88e6xxx_chip *chip)
1255
{
1256
	return mv88e6xxx_g1_wait(chip, GLOBAL_VTU_OP, GLOBAL_VTU_OP_BUSY);
1257 1258
}

1259
static int _mv88e6xxx_vtu_cmd(struct mv88e6xxx_chip *chip, u16 op)
1260
{
1261
	int err;
1262

1263 1264 1265
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_OP, op);
	if (err)
		return err;
1266

1267
	return _mv88e6xxx_vtu_wait(chip);
1268 1269
}

1270
static int _mv88e6xxx_vtu_stu_flush(struct mv88e6xxx_chip *chip)
1271 1272 1273
{
	int ret;

1274
	ret = _mv88e6xxx_vtu_wait(chip);
1275 1276 1277
	if (ret < 0)
		return ret;

1278
	return _mv88e6xxx_vtu_cmd(chip, GLOBAL_VTU_OP_FLUSH_ALL);
1279 1280
}

1281
static int _mv88e6xxx_vtu_stu_data_read(struct mv88e6xxx_chip *chip,
1282
					struct mv88e6xxx_vtu_entry *entry,
1283 1284 1285
					unsigned int nibble_offset)
{
	u16 regs[3];
1286
	int i, err;
1287 1288

	for (i = 0; i < 3; ++i) {
1289
		u16 *reg = &regs[i];
1290

1291 1292 1293
		err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_DATA_0_3 + i, reg);
		if (err)
			return err;
1294 1295
	}

1296
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1297 1298 1299 1300 1301 1302 1303 1304 1305
		unsigned int shift = (i % 4) * 4 + nibble_offset;
		u16 reg = regs[i / 4];

		entry->data[i] = (reg >> shift) & GLOBAL_VTU_STU_DATA_MASK;
	}

	return 0;
}

1306
static int mv88e6xxx_vtu_data_read(struct mv88e6xxx_chip *chip,
1307
				   struct mv88e6xxx_vtu_entry *entry)
1308
{
1309
	return _mv88e6xxx_vtu_stu_data_read(chip, entry, 0);
1310 1311
}

1312
static int mv88e6xxx_stu_data_read(struct mv88e6xxx_chip *chip,
1313
				   struct mv88e6xxx_vtu_entry *entry)
1314
{
1315
	return _mv88e6xxx_vtu_stu_data_read(chip, entry, 2);
1316 1317
}

1318
static int _mv88e6xxx_vtu_stu_data_write(struct mv88e6xxx_chip *chip,
1319
					 struct mv88e6xxx_vtu_entry *entry,
1320 1321 1322
					 unsigned int nibble_offset)
{
	u16 regs[3] = { 0 };
1323
	int i, err;
1324

1325
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1326 1327 1328 1329 1330 1331 1332
		unsigned int shift = (i % 4) * 4 + nibble_offset;
		u8 data = entry->data[i];

		regs[i / 4] |= (data & GLOBAL_VTU_STU_DATA_MASK) << shift;
	}

	for (i = 0; i < 3; ++i) {
1333 1334 1335 1336 1337
		u16 reg = regs[i];

		err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_DATA_0_3 + i, reg);
		if (err)
			return err;
1338 1339 1340 1341 1342
	}

	return 0;
}

1343
static int mv88e6xxx_vtu_data_write(struct mv88e6xxx_chip *chip,
1344
				    struct mv88e6xxx_vtu_entry *entry)
1345
{
1346
	return _mv88e6xxx_vtu_stu_data_write(chip, entry, 0);
1347 1348
}

1349
static int mv88e6xxx_stu_data_write(struct mv88e6xxx_chip *chip,
1350
				    struct mv88e6xxx_vtu_entry *entry)
1351
{
1352
	return _mv88e6xxx_vtu_stu_data_write(chip, entry, 2);
1353 1354
}

1355
static int _mv88e6xxx_vtu_vid_write(struct mv88e6xxx_chip *chip, u16 vid)
1356
{
1357 1358
	return mv88e6xxx_g1_write(chip, GLOBAL_VTU_VID,
				  vid & GLOBAL_VTU_VID_MASK);
1359 1360
}

1361
static int _mv88e6xxx_vtu_getnext(struct mv88e6xxx_chip *chip,
1362
				  struct mv88e6xxx_vtu_entry *entry)
1363
{
1364
	struct mv88e6xxx_vtu_entry next = { 0 };
1365 1366
	u16 val;
	int err;
1367

1368 1369 1370
	err = _mv88e6xxx_vtu_wait(chip);
	if (err)
		return err;
1371

1372 1373 1374
	err = _mv88e6xxx_vtu_cmd(chip, GLOBAL_VTU_OP_VTU_GET_NEXT);
	if (err)
		return err;
1375

1376 1377 1378
	err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_VID, &val);
	if (err)
		return err;
1379

1380 1381
	next.vid = val & GLOBAL_VTU_VID_MASK;
	next.valid = !!(val & GLOBAL_VTU_VID_VALID);
1382 1383

	if (next.valid) {
1384 1385 1386
		err = mv88e6xxx_vtu_data_read(chip, &next);
		if (err)
			return err;
1387

1388
		if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G1_VTU_FID)) {
1389 1390 1391
			err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_FID, &val);
			if (err)
				return err;
1392

1393
			next.fid = val & GLOBAL_VTU_FID_MASK;
1394
		} else if (mv88e6xxx_num_databases(chip) == 256) {
1395 1396 1397
			/* VTU DBNum[7:4] are located in VTU Operation 11:8, and
			 * VTU DBNum[3:0] are located in VTU Operation 3:0
			 */
1398 1399 1400
			err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_OP, &val);
			if (err)
				return err;
1401

1402 1403
			next.fid = (val & 0xf00) >> 4;
			next.fid |= val & 0xf;
1404
		}
1405

1406
		if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_STU)) {
1407 1408 1409
			err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_SID, &val);
			if (err)
				return err;
1410

1411
			next.sid = val & GLOBAL_VTU_SID_MASK;
1412 1413 1414 1415 1416 1417 1418
		}
	}

	*entry = next;
	return 0;
}

1419 1420 1421
static int mv88e6xxx_port_vlan_dump(struct dsa_switch *ds, int port,
				    struct switchdev_obj_port_vlan *vlan,
				    int (*cb)(struct switchdev_obj *obj))
1422
{
V
Vivien Didelot 已提交
1423
	struct mv88e6xxx_chip *chip = ds->priv;
1424
	struct mv88e6xxx_vtu_entry next;
1425 1426 1427
	u16 pvid;
	int err;

1428
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1429 1430
		return -EOPNOTSUPP;

1431
	mutex_lock(&chip->reg_lock);
1432

1433
	err = mv88e6xxx_port_get_pvid(chip, port, &pvid);
1434 1435 1436
	if (err)
		goto unlock;

1437
	err = _mv88e6xxx_vtu_vid_write(chip, GLOBAL_VTU_VID_MASK);
1438 1439 1440 1441
	if (err)
		goto unlock;

	do {
1442
		err = _mv88e6xxx_vtu_getnext(chip, &next);
1443 1444 1445 1446 1447 1448 1449 1450 1451 1452
		if (err)
			break;

		if (!next.valid)
			break;

		if (next.data[port] == GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER)
			continue;

		/* reinit and dump this VLAN obj */
1453 1454
		vlan->vid_begin = next.vid;
		vlan->vid_end = next.vid;
1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468
		vlan->flags = 0;

		if (next.data[port] == GLOBAL_VTU_DATA_MEMBER_TAG_UNTAGGED)
			vlan->flags |= BRIDGE_VLAN_INFO_UNTAGGED;

		if (next.vid == pvid)
			vlan->flags |= BRIDGE_VLAN_INFO_PVID;

		err = cb(&vlan->obj);
		if (err)
			break;
	} while (next.vid < GLOBAL_VTU_VID_MASK);

unlock:
1469
	mutex_unlock(&chip->reg_lock);
1470 1471 1472 1473

	return err;
}

1474
static int _mv88e6xxx_vtu_loadpurge(struct mv88e6xxx_chip *chip,
1475
				    struct mv88e6xxx_vtu_entry *entry)
1476
{
1477
	u16 op = GLOBAL_VTU_OP_VTU_LOAD_PURGE;
1478
	u16 reg = 0;
1479
	int err;
1480

1481 1482 1483
	err = _mv88e6xxx_vtu_wait(chip);
	if (err)
		return err;
1484 1485 1486 1487 1488

	if (!entry->valid)
		goto loadpurge;

	/* Write port member tags */
1489 1490 1491
	err = mv88e6xxx_vtu_data_write(chip, entry);
	if (err)
		return err;
1492

1493
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_STU)) {
1494
		reg = entry->sid & GLOBAL_VTU_SID_MASK;
1495 1496 1497
		err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_SID, reg);
		if (err)
			return err;
1498
	}
1499

1500
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G1_VTU_FID)) {
1501
		reg = entry->fid & GLOBAL_VTU_FID_MASK;
1502 1503 1504
		err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_FID, reg);
		if (err)
			return err;
1505
	} else if (mv88e6xxx_num_databases(chip) == 256) {
1506 1507 1508 1509 1510
		/* VTU DBNum[7:4] are located in VTU Operation 11:8, and
		 * VTU DBNum[3:0] are located in VTU Operation 3:0
		 */
		op |= (entry->fid & 0xf0) << 8;
		op |= entry->fid & 0xf;
1511 1512 1513 1514 1515
	}

	reg = GLOBAL_VTU_VID_VALID;
loadpurge:
	reg |= entry->vid & GLOBAL_VTU_VID_MASK;
1516 1517 1518
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_VID, reg);
	if (err)
		return err;
1519

1520
	return _mv88e6xxx_vtu_cmd(chip, op);
1521 1522
}

1523
static int _mv88e6xxx_stu_getnext(struct mv88e6xxx_chip *chip, u8 sid,
1524
				  struct mv88e6xxx_vtu_entry *entry)
1525
{
1526
	struct mv88e6xxx_vtu_entry next = { 0 };
1527 1528
	u16 val;
	int err;
1529

1530 1531 1532
	err = _mv88e6xxx_vtu_wait(chip);
	if (err)
		return err;
1533

1534 1535 1536 1537
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_SID,
				 sid & GLOBAL_VTU_SID_MASK);
	if (err)
		return err;
1538

1539 1540 1541
	err = _mv88e6xxx_vtu_cmd(chip, GLOBAL_VTU_OP_STU_GET_NEXT);
	if (err)
		return err;
1542

1543 1544 1545
	err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_SID, &val);
	if (err)
		return err;
1546

1547
	next.sid = val & GLOBAL_VTU_SID_MASK;
1548

1549 1550 1551
	err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_VID, &val);
	if (err)
		return err;
1552

1553
	next.valid = !!(val & GLOBAL_VTU_VID_VALID);
1554 1555

	if (next.valid) {
1556 1557 1558
		err = mv88e6xxx_stu_data_read(chip, &next);
		if (err)
			return err;
1559 1560 1561 1562 1563 1564
	}

	*entry = next;
	return 0;
}

1565
static int _mv88e6xxx_stu_loadpurge(struct mv88e6xxx_chip *chip,
1566
				    struct mv88e6xxx_vtu_entry *entry)
1567 1568
{
	u16 reg = 0;
1569
	int err;
1570

1571 1572 1573
	err = _mv88e6xxx_vtu_wait(chip);
	if (err)
		return err;
1574 1575 1576 1577 1578

	if (!entry->valid)
		goto loadpurge;

	/* Write port states */
1579 1580 1581
	err = mv88e6xxx_stu_data_write(chip, entry);
	if (err)
		return err;
1582 1583 1584

	reg = GLOBAL_VTU_VID_VALID;
loadpurge:
1585 1586 1587
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_VID, reg);
	if (err)
		return err;
1588 1589

	reg = entry->sid & GLOBAL_VTU_SID_MASK;
1590 1591 1592
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_SID, reg);
	if (err)
		return err;
1593

1594
	return _mv88e6xxx_vtu_cmd(chip, GLOBAL_VTU_OP_STU_LOAD_PURGE);
1595 1596
}

1597
static int mv88e6xxx_atu_new(struct mv88e6xxx_chip *chip, u16 *fid)
1598 1599
{
	DECLARE_BITMAP(fid_bitmap, MV88E6XXX_N_FID);
1600
	struct mv88e6xxx_vtu_entry vlan;
1601
	int i, err;
1602 1603 1604

	bitmap_zero(fid_bitmap, MV88E6XXX_N_FID);

1605
	/* Set every FID bit used by the (un)bridged ports */
1606
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1607
		err = mv88e6xxx_port_get_fid(chip, i, fid);
1608 1609 1610 1611 1612 1613
		if (err)
			return err;

		set_bit(*fid, fid_bitmap);
	}

1614
	/* Set every FID bit used by the VLAN entries */
1615
	err = _mv88e6xxx_vtu_vid_write(chip, GLOBAL_VTU_VID_MASK);
1616 1617 1618 1619
	if (err)
		return err;

	do {
1620
		err = _mv88e6xxx_vtu_getnext(chip, &vlan);
1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633
		if (err)
			return err;

		if (!vlan.valid)
			break;

		set_bit(vlan.fid, fid_bitmap);
	} while (vlan.vid < GLOBAL_VTU_VID_MASK);

	/* The reset value 0x000 is used to indicate that multiple address
	 * databases are not needed. Return the next positive available.
	 */
	*fid = find_next_zero_bit(fid_bitmap, MV88E6XXX_N_FID, 1);
1634
	if (unlikely(*fid >= mv88e6xxx_num_databases(chip)))
1635 1636 1637
		return -ENOSPC;

	/* Clear the database */
1638
	return mv88e6xxx_g1_atu_flush(chip, *fid, true);
1639 1640
}

1641
static int _mv88e6xxx_vtu_new(struct mv88e6xxx_chip *chip, u16 vid,
1642
			      struct mv88e6xxx_vtu_entry *entry)
1643
{
1644
	struct dsa_switch *ds = chip->ds;
1645
	struct mv88e6xxx_vtu_entry vlan = {
1646 1647 1648
		.valid = true,
		.vid = vid,
	};
1649 1650
	int i, err;

1651
	err = mv88e6xxx_atu_new(chip, &vlan.fid);
1652 1653
	if (err)
		return err;
1654

1655
	/* exclude all ports except the CPU and DSA ports */
1656
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i)
1657 1658 1659
		vlan.data[i] = dsa_is_cpu_port(ds, i) || dsa_is_dsa_port(ds, i)
			? GLOBAL_VTU_DATA_MEMBER_TAG_UNMODIFIED
			: GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER;
1660

1661
	if (mv88e6xxx_6097_family(chip) || mv88e6xxx_6165_family(chip) ||
1662 1663
	    mv88e6xxx_6351_family(chip) || mv88e6xxx_6352_family(chip) ||
	    mv88e6xxx_6341_family(chip)) {
1664
		struct mv88e6xxx_vtu_entry vstp;
1665 1666 1667 1668 1669 1670

		/* Adding a VTU entry requires a valid STU entry. As VSTP is not
		 * implemented, only one STU entry is needed to cover all VTU
		 * entries. Thus, validate the SID 0.
		 */
		vlan.sid = 0;
1671
		err = _mv88e6xxx_stu_getnext(chip, GLOBAL_VTU_SID_MASK, &vstp);
1672 1673 1674 1675 1676 1677 1678 1679
		if (err)
			return err;

		if (vstp.sid != vlan.sid || !vstp.valid) {
			memset(&vstp, 0, sizeof(vstp));
			vstp.valid = true;
			vstp.sid = vlan.sid;

1680
			err = _mv88e6xxx_stu_loadpurge(chip, &vstp);
1681 1682 1683 1684 1685 1686 1687 1688 1689
			if (err)
				return err;
		}
	}

	*entry = vlan;
	return 0;
}

1690
static int _mv88e6xxx_vtu_get(struct mv88e6xxx_chip *chip, u16 vid,
1691
			      struct mv88e6xxx_vtu_entry *entry, bool creat)
1692 1693 1694 1695 1696 1697
{
	int err;

	if (!vid)
		return -EINVAL;

1698
	err = _mv88e6xxx_vtu_vid_write(chip, vid - 1);
1699 1700 1701
	if (err)
		return err;

1702
	err = _mv88e6xxx_vtu_getnext(chip, entry);
1703 1704 1705 1706 1707 1708 1709 1710 1711 1712
	if (err)
		return err;

	if (entry->vid != vid || !entry->valid) {
		if (!creat)
			return -EOPNOTSUPP;
		/* -ENOENT would've been more appropriate, but switchdev expects
		 * -EOPNOTSUPP to inform bridge about an eventual software VLAN.
		 */

1713
		err = _mv88e6xxx_vtu_new(chip, vid, entry);
1714 1715 1716 1717 1718
	}

	return err;
}

1719 1720 1721
static int mv88e6xxx_port_check_hw_vlan(struct dsa_switch *ds, int port,
					u16 vid_begin, u16 vid_end)
{
V
Vivien Didelot 已提交
1722
	struct mv88e6xxx_chip *chip = ds->priv;
1723
	struct mv88e6xxx_vtu_entry vlan;
1724 1725 1726 1727 1728
	int i, err;

	if (!vid_begin)
		return -EOPNOTSUPP;

1729
	mutex_lock(&chip->reg_lock);
1730

1731
	err = _mv88e6xxx_vtu_vid_write(chip, vid_begin - 1);
1732 1733 1734 1735
	if (err)
		goto unlock;

	do {
1736
		err = _mv88e6xxx_vtu_getnext(chip, &vlan);
1737 1738 1739 1740 1741 1742 1743 1744 1745
		if (err)
			goto unlock;

		if (!vlan.valid)
			break;

		if (vlan.vid > vid_end)
			break;

1746
		for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1747 1748 1749
			if (dsa_is_dsa_port(ds, i) || dsa_is_cpu_port(ds, i))
				continue;

1750 1751 1752
			if (!ds->ports[port].netdev)
				continue;

1753 1754 1755 1756
			if (vlan.data[i] ==
			    GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER)
				continue;

1757 1758
			if (ds->ports[i].bridge_dev ==
			    ds->ports[port].bridge_dev)
1759 1760
				break; /* same bridge, check next VLAN */

1761
			if (!ds->ports[i].bridge_dev)
1762 1763
				continue;

1764
			netdev_warn(ds->ports[port].netdev,
1765 1766
				    "hardware VLAN %d already used by %s\n",
				    vlan.vid,
1767
				    netdev_name(ds->ports[i].bridge_dev));
1768 1769 1770 1771 1772 1773
			err = -EOPNOTSUPP;
			goto unlock;
		}
	} while (vlan.vid < vid_end);

unlock:
1774
	mutex_unlock(&chip->reg_lock);
1775 1776 1777 1778

	return err;
}

1779 1780
static int mv88e6xxx_port_vlan_filtering(struct dsa_switch *ds, int port,
					 bool vlan_filtering)
1781
{
V
Vivien Didelot 已提交
1782
	struct mv88e6xxx_chip *chip = ds->priv;
1783
	u16 mode = vlan_filtering ? PORT_CONTROL_2_8021Q_SECURE :
1784
		PORT_CONTROL_2_8021Q_DISABLED;
1785
	int err;
1786

1787
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1788 1789
		return -EOPNOTSUPP;

1790
	mutex_lock(&chip->reg_lock);
1791
	err = mv88e6xxx_port_set_8021q_mode(chip, port, mode);
1792
	mutex_unlock(&chip->reg_lock);
1793

1794
	return err;
1795 1796
}

1797 1798 1799 1800
static int
mv88e6xxx_port_vlan_prepare(struct dsa_switch *ds, int port,
			    const struct switchdev_obj_port_vlan *vlan,
			    struct switchdev_trans *trans)
1801
{
V
Vivien Didelot 已提交
1802
	struct mv88e6xxx_chip *chip = ds->priv;
1803 1804
	int err;

1805
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1806 1807
		return -EOPNOTSUPP;

1808 1809 1810 1811 1812 1813 1814 1815
	/* If the requested port doesn't belong to the same bridge as the VLAN
	 * members, do not support it (yet) and fallback to software VLAN.
	 */
	err = mv88e6xxx_port_check_hw_vlan(ds, port, vlan->vid_begin,
					   vlan->vid_end);
	if (err)
		return err;

1816 1817 1818 1819 1820 1821
	/* We don't need any dynamic resource from the kernel (yet),
	 * so skip the prepare phase.
	 */
	return 0;
}

1822
static int _mv88e6xxx_port_vlan_add(struct mv88e6xxx_chip *chip, int port,
1823
				    u16 vid, bool untagged)
1824
{
1825
	struct mv88e6xxx_vtu_entry vlan;
1826 1827
	int err;

1828
	err = _mv88e6xxx_vtu_get(chip, vid, &vlan, true);
1829
	if (err)
1830
		return err;
1831 1832 1833 1834 1835

	vlan.data[port] = untagged ?
		GLOBAL_VTU_DATA_MEMBER_TAG_UNTAGGED :
		GLOBAL_VTU_DATA_MEMBER_TAG_TAGGED;

1836
	return _mv88e6xxx_vtu_loadpurge(chip, &vlan);
1837 1838
}

1839 1840 1841
static void mv88e6xxx_port_vlan_add(struct dsa_switch *ds, int port,
				    const struct switchdev_obj_port_vlan *vlan,
				    struct switchdev_trans *trans)
1842
{
V
Vivien Didelot 已提交
1843
	struct mv88e6xxx_chip *chip = ds->priv;
1844 1845 1846 1847
	bool untagged = vlan->flags & BRIDGE_VLAN_INFO_UNTAGGED;
	bool pvid = vlan->flags & BRIDGE_VLAN_INFO_PVID;
	u16 vid;

1848
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1849 1850
		return;

1851
	mutex_lock(&chip->reg_lock);
1852

1853
	for (vid = vlan->vid_begin; vid <= vlan->vid_end; ++vid)
1854
		if (_mv88e6xxx_port_vlan_add(chip, port, vid, untagged))
1855 1856
			netdev_err(ds->ports[port].netdev,
				   "failed to add VLAN %d%c\n",
1857
				   vid, untagged ? 'u' : 't');
1858

1859
	if (pvid && mv88e6xxx_port_set_pvid(chip, port, vlan->vid_end))
1860
		netdev_err(ds->ports[port].netdev, "failed to set PVID %d\n",
1861
			   vlan->vid_end);
1862

1863
	mutex_unlock(&chip->reg_lock);
1864 1865
}

1866
static int _mv88e6xxx_port_vlan_del(struct mv88e6xxx_chip *chip,
1867
				    int port, u16 vid)
1868
{
1869
	struct dsa_switch *ds = chip->ds;
1870
	struct mv88e6xxx_vtu_entry vlan;
1871 1872
	int i, err;

1873
	err = _mv88e6xxx_vtu_get(chip, vid, &vlan, false);
1874
	if (err)
1875
		return err;
1876

1877 1878
	/* Tell switchdev if this VLAN is handled in software */
	if (vlan.data[port] == GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER)
1879
		return -EOPNOTSUPP;
1880 1881 1882 1883

	vlan.data[port] = GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER;

	/* keep the VLAN unless all ports are excluded */
1884
	vlan.valid = false;
1885
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1886
		if (dsa_is_cpu_port(ds, i) || dsa_is_dsa_port(ds, i))
1887 1888 1889
			continue;

		if (vlan.data[i] != GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER) {
1890
			vlan.valid = true;
1891 1892 1893 1894
			break;
		}
	}

1895
	err = _mv88e6xxx_vtu_loadpurge(chip, &vlan);
1896 1897 1898
	if (err)
		return err;

1899
	return mv88e6xxx_g1_atu_remove(chip, vlan.fid, port, false);
1900 1901
}

1902 1903
static int mv88e6xxx_port_vlan_del(struct dsa_switch *ds, int port,
				   const struct switchdev_obj_port_vlan *vlan)
1904
{
V
Vivien Didelot 已提交
1905
	struct mv88e6xxx_chip *chip = ds->priv;
1906 1907 1908
	u16 pvid, vid;
	int err = 0;

1909
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1910 1911
		return -EOPNOTSUPP;

1912
	mutex_lock(&chip->reg_lock);
1913

1914
	err = mv88e6xxx_port_get_pvid(chip, port, &pvid);
1915 1916 1917
	if (err)
		goto unlock;

1918
	for (vid = vlan->vid_begin; vid <= vlan->vid_end; ++vid) {
1919
		err = _mv88e6xxx_port_vlan_del(chip, port, vid);
1920 1921 1922 1923
		if (err)
			goto unlock;

		if (vid == pvid) {
1924
			err = mv88e6xxx_port_set_pvid(chip, port, 0);
1925 1926 1927 1928 1929
			if (err)
				goto unlock;
		}
	}

1930
unlock:
1931
	mutex_unlock(&chip->reg_lock);
1932 1933 1934 1935

	return err;
}

1936 1937 1938
static int mv88e6xxx_port_db_load_purge(struct mv88e6xxx_chip *chip, int port,
					const unsigned char *addr, u16 vid,
					u8 state)
1939
{
1940
	struct mv88e6xxx_vtu_entry vlan;
1941
	struct mv88e6xxx_atu_entry entry;
1942 1943
	int err;

1944 1945
	/* Null VLAN ID corresponds to the port private database */
	if (vid == 0)
1946
		err = mv88e6xxx_port_get_fid(chip, port, &vlan.fid);
1947
	else
1948
		err = _mv88e6xxx_vtu_get(chip, vid, &vlan, false);
1949 1950
	if (err)
		return err;
1951

1952 1953 1954 1955 1956
	entry.state = GLOBAL_ATU_DATA_STATE_UNUSED;
	ether_addr_copy(entry.mac, addr);
	eth_addr_dec(entry.mac);

	err = mv88e6xxx_g1_atu_getnext(chip, vlan.fid, &entry);
1957 1958 1959
	if (err)
		return err;

1960 1961 1962 1963 1964 1965 1966
	/* Initialize a fresh ATU entry if it isn't found */
	if (entry.state == GLOBAL_ATU_DATA_STATE_UNUSED ||
	    !ether_addr_equal(entry.mac, addr)) {
		memset(&entry, 0, sizeof(entry));
		ether_addr_copy(entry.mac, addr);
	}

1967 1968
	/* Purge the ATU entry only if no port is using it anymore */
	if (state == GLOBAL_ATU_DATA_STATE_UNUSED) {
1969 1970
		entry.portvec &= ~BIT(port);
		if (!entry.portvec)
1971 1972
			entry.state = GLOBAL_ATU_DATA_STATE_UNUSED;
	} else {
1973
		entry.portvec |= BIT(port);
1974
		entry.state = state;
1975 1976
	}

1977
	return mv88e6xxx_g1_atu_loadpurge(chip, vlan.fid, &entry);
1978 1979
}

1980 1981 1982
static int mv88e6xxx_port_fdb_prepare(struct dsa_switch *ds, int port,
				      const struct switchdev_obj_port_fdb *fdb,
				      struct switchdev_trans *trans)
V
Vivien Didelot 已提交
1983 1984 1985 1986 1987 1988 1989
{
	/* We don't need any dynamic resource from the kernel (yet),
	 * so skip the prepare phase.
	 */
	return 0;
}

1990 1991 1992
static void mv88e6xxx_port_fdb_add(struct dsa_switch *ds, int port,
				   const struct switchdev_obj_port_fdb *fdb,
				   struct switchdev_trans *trans)
1993
{
V
Vivien Didelot 已提交
1994
	struct mv88e6xxx_chip *chip = ds->priv;
1995

1996
	mutex_lock(&chip->reg_lock);
1997 1998 1999
	if (mv88e6xxx_port_db_load_purge(chip, port, fdb->addr, fdb->vid,
					 GLOBAL_ATU_DATA_STATE_UC_STATIC))
		netdev_err(ds->ports[port].netdev, "failed to load unicast MAC address\n");
2000
	mutex_unlock(&chip->reg_lock);
2001 2002
}

2003 2004
static int mv88e6xxx_port_fdb_del(struct dsa_switch *ds, int port,
				  const struct switchdev_obj_port_fdb *fdb)
2005
{
V
Vivien Didelot 已提交
2006
	struct mv88e6xxx_chip *chip = ds->priv;
2007
	int err;
2008

2009
	mutex_lock(&chip->reg_lock);
2010 2011
	err = mv88e6xxx_port_db_load_purge(chip, port, fdb->addr, fdb->vid,
					   GLOBAL_ATU_DATA_STATE_UNUSED);
2012
	mutex_unlock(&chip->reg_lock);
2013

2014
	return err;
2015 2016
}

2017 2018 2019 2020
static int mv88e6xxx_port_db_dump_fid(struct mv88e6xxx_chip *chip,
				      u16 fid, u16 vid, int port,
				      struct switchdev_obj *obj,
				      int (*cb)(struct switchdev_obj *obj))
2021
{
2022
	struct mv88e6xxx_atu_entry addr;
2023 2024
	int err;

2025 2026
	addr.state = GLOBAL_ATU_DATA_STATE_UNUSED;
	eth_broadcast_addr(addr.mac);
2027 2028

	do {
2029
		err = mv88e6xxx_g1_atu_getnext(chip, fid, &addr);
2030
		if (err)
2031
			return err;
2032 2033 2034 2035

		if (addr.state == GLOBAL_ATU_DATA_STATE_UNUSED)
			break;

2036
		if (addr.trunk || (addr.portvec & BIT(port)) == 0)
2037 2038 2039 2040
			continue;

		if (obj->id == SWITCHDEV_OBJ_ID_PORT_FDB) {
			struct switchdev_obj_port_fdb *fdb;
2041

2042 2043 2044 2045
			if (!is_unicast_ether_addr(addr.mac))
				continue;

			fdb = SWITCHDEV_OBJ_PORT_FDB(obj);
2046 2047
			fdb->vid = vid;
			ether_addr_copy(fdb->addr, addr.mac);
2048 2049 2050 2051
			if (addr.state == GLOBAL_ATU_DATA_STATE_UC_STATIC)
				fdb->ndm_state = NUD_NOARP;
			else
				fdb->ndm_state = NUD_REACHABLE;
2052 2053 2054 2055 2056 2057 2058 2059 2060
		} else if (obj->id == SWITCHDEV_OBJ_ID_PORT_MDB) {
			struct switchdev_obj_port_mdb *mdb;

			if (!is_multicast_ether_addr(addr.mac))
				continue;

			mdb = SWITCHDEV_OBJ_PORT_MDB(obj);
			mdb->vid = vid;
			ether_addr_copy(mdb->addr, addr.mac);
2061 2062
		} else {
			return -EOPNOTSUPP;
2063
		}
2064 2065 2066 2067

		err = cb(obj);
		if (err)
			return err;
2068 2069 2070 2071 2072
	} while (!is_broadcast_ether_addr(addr.mac));

	return err;
}

2073 2074 2075
static int mv88e6xxx_port_db_dump(struct mv88e6xxx_chip *chip, int port,
				  struct switchdev_obj *obj,
				  int (*cb)(struct switchdev_obj *obj))
2076
{
2077
	struct mv88e6xxx_vtu_entry vlan = {
2078 2079
		.vid = GLOBAL_VTU_VID_MASK, /* all ones */
	};
2080
	u16 fid;
2081 2082
	int err;

2083
	/* Dump port's default Filtering Information Database (VLAN ID 0) */
2084
	err = mv88e6xxx_port_get_fid(chip, port, &fid);
2085
	if (err)
2086
		return err;
2087

2088
	err = mv88e6xxx_port_db_dump_fid(chip, fid, 0, port, obj, cb);
2089
	if (err)
2090
		return err;
2091

2092
	/* Dump VLANs' Filtering Information Databases */
2093
	err = _mv88e6xxx_vtu_vid_write(chip, vlan.vid);
2094
	if (err)
2095
		return err;
2096 2097

	do {
2098
		err = _mv88e6xxx_vtu_getnext(chip, &vlan);
2099
		if (err)
2100
			return err;
2101 2102 2103 2104

		if (!vlan.valid)
			break;

2105 2106
		err = mv88e6xxx_port_db_dump_fid(chip, vlan.fid, vlan.vid, port,
						 obj, cb);
2107
		if (err)
2108
			return err;
2109 2110
	} while (vlan.vid < GLOBAL_VTU_VID_MASK);

2111 2112 2113 2114 2115 2116 2117
	return err;
}

static int mv88e6xxx_port_fdb_dump(struct dsa_switch *ds, int port,
				   struct switchdev_obj_port_fdb *fdb,
				   int (*cb)(struct switchdev_obj *obj))
{
V
Vivien Didelot 已提交
2118
	struct mv88e6xxx_chip *chip = ds->priv;
2119 2120 2121 2122
	int err;

	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_port_db_dump(chip, port, &fdb->obj, cb);
2123
	mutex_unlock(&chip->reg_lock);
2124 2125 2126 2127

	return err;
}

2128
static int mv88e6xxx_port_bridge_join(struct dsa_switch *ds, int port,
2129
				      struct net_device *br)
2130
{
V
Vivien Didelot 已提交
2131
	struct mv88e6xxx_chip *chip = ds->priv;
2132
	int i, err = 0;
2133

2134
	mutex_lock(&chip->reg_lock);
2135

2136
	/* Remap each port's VLANTable */
2137
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
2138
		if (ds->ports[i].bridge_dev == br) {
2139
			err = _mv88e6xxx_port_based_vlan_map(chip, i);
2140 2141 2142 2143 2144
			if (err)
				break;
		}
	}

2145
	mutex_unlock(&chip->reg_lock);
2146

2147
	return err;
2148 2149
}

2150 2151
static void mv88e6xxx_port_bridge_leave(struct dsa_switch *ds, int port,
					struct net_device *br)
2152
{
V
Vivien Didelot 已提交
2153
	struct mv88e6xxx_chip *chip = ds->priv;
2154
	int i;
2155

2156
	mutex_lock(&chip->reg_lock);
2157

2158
	/* Remap each port's VLANTable */
2159
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i)
2160
		if (i == port || ds->ports[i].bridge_dev == br)
2161
			if (_mv88e6xxx_port_based_vlan_map(chip, i))
2162 2163
				netdev_warn(ds->ports[i].netdev,
					    "failed to remap\n");
2164

2165
	mutex_unlock(&chip->reg_lock);
2166 2167
}

2168 2169 2170 2171 2172 2173 2174 2175
static int mv88e6xxx_software_reset(struct mv88e6xxx_chip *chip)
{
	if (chip->info->ops->reset)
		return chip->info->ops->reset(chip);

	return 0;
}

2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188
static void mv88e6xxx_hardware_reset(struct mv88e6xxx_chip *chip)
{
	struct gpio_desc *gpiod = chip->reset;

	/* If there is a GPIO connected to the reset pin, toggle it */
	if (gpiod) {
		gpiod_set_value_cansleep(gpiod, 1);
		usleep_range(10000, 20000);
		gpiod_set_value_cansleep(gpiod, 0);
		usleep_range(10000, 20000);
	}
}

2189
static int mv88e6xxx_disable_ports(struct mv88e6xxx_chip *chip)
2190
{
2191
	int i, err;
2192

2193
	/* Set all ports to the Disabled state */
2194
	for (i = 0; i < mv88e6xxx_num_ports(chip); i++) {
2195 2196
		err = mv88e6xxx_port_set_state(chip, i,
					       PORT_CONTROL_STATE_DISABLED);
2197 2198
		if (err)
			return err;
2199 2200
	}

2201 2202 2203
	/* Wait for transmit queues to drain,
	 * i.e. 2ms for a maximum frame to be transmitted at 10 Mbps.
	 */
2204 2205
	usleep_range(2000, 4000);

2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216
	return 0;
}

static int mv88e6xxx_switch_reset(struct mv88e6xxx_chip *chip)
{
	int err;

	err = mv88e6xxx_disable_ports(chip);
	if (err)
		return err;

2217
	mv88e6xxx_hardware_reset(chip);
2218

2219
	return mv88e6xxx_software_reset(chip);
2220 2221
}

2222
static int mv88e6xxx_serdes_power_on(struct mv88e6xxx_chip *chip)
2223
{
2224 2225
	u16 val;
	int err;
2226

2227 2228 2229 2230
	/* Clear Power Down bit */
	err = mv88e6xxx_serdes_read(chip, MII_BMCR, &val);
	if (err)
		return err;
2231

2232 2233 2234
	if (val & BMCR_PDOWN) {
		val &= ~BMCR_PDOWN;
		err = mv88e6xxx_serdes_write(chip, MII_BMCR, val);
2235 2236
	}

2237
	return err;
2238 2239
}

2240 2241 2242
static int mv88e6xxx_set_port_mode(struct mv88e6xxx_chip *chip, int port,
				   enum mv88e6xxx_frame_mode frame, u16 egress,
				   u16 etype)
2243 2244 2245
{
	int err;

2246 2247 2248 2249
	if (!chip->info->ops->port_set_frame_mode)
		return -EOPNOTSUPP;

	err = mv88e6xxx_port_set_egress_mode(chip, port, egress);
2250 2251 2252
	if (err)
		return err;

2253 2254 2255 2256 2257 2258 2259 2260
	err = chip->info->ops->port_set_frame_mode(chip, port, frame);
	if (err)
		return err;

	if (chip->info->ops->port_set_ether_type)
		return chip->info->ops->port_set_ether_type(chip, port, etype);

	return 0;
2261 2262
}

2263
static int mv88e6xxx_set_port_mode_normal(struct mv88e6xxx_chip *chip, int port)
2264
{
2265 2266 2267 2268
	return mv88e6xxx_set_port_mode(chip, port, MV88E6XXX_FRAME_MODE_NORMAL,
				       PORT_CONTROL_EGRESS_UNMODIFIED,
				       PORT_ETH_TYPE_DEFAULT);
}
2269

2270 2271 2272 2273 2274 2275
static int mv88e6xxx_set_port_mode_dsa(struct mv88e6xxx_chip *chip, int port)
{
	return mv88e6xxx_set_port_mode(chip, port, MV88E6XXX_FRAME_MODE_DSA,
				       PORT_CONTROL_EGRESS_UNMODIFIED,
				       PORT_ETH_TYPE_DEFAULT);
}
2276

2277 2278 2279 2280 2281 2282
static int mv88e6xxx_set_port_mode_edsa(struct mv88e6xxx_chip *chip, int port)
{
	return mv88e6xxx_set_port_mode(chip, port,
				       MV88E6XXX_FRAME_MODE_ETHERTYPE,
				       PORT_CONTROL_EGRESS_ADD_TAG, ETH_P_EDSA);
}
2283

2284 2285 2286 2287
static int mv88e6xxx_setup_port_mode(struct mv88e6xxx_chip *chip, int port)
{
	if (dsa_is_dsa_port(chip->ds, port))
		return mv88e6xxx_set_port_mode_dsa(chip, port);
2288

2289 2290
	if (dsa_is_normal_port(chip->ds, port))
		return mv88e6xxx_set_port_mode_normal(chip, port);
2291

2292 2293 2294
	/* Setup CPU port mode depending on its supported tag format */
	if (chip->info->tag_protocol == DSA_TAG_PROTO_DSA)
		return mv88e6xxx_set_port_mode_dsa(chip, port);
2295

2296 2297
	if (chip->info->tag_protocol == DSA_TAG_PROTO_EDSA)
		return mv88e6xxx_set_port_mode_edsa(chip, port);
2298

2299
	return -EINVAL;
2300 2301
}

2302
static int mv88e6xxx_setup_message_port(struct mv88e6xxx_chip *chip, int port)
2303
{
2304
	bool message = dsa_is_dsa_port(chip->ds, port);
2305

2306
	return mv88e6xxx_port_set_message_port(chip, port, message);
2307
}
2308

2309
static int mv88e6xxx_setup_egress_floods(struct mv88e6xxx_chip *chip, int port)
2310
{
2311
	bool flood = port == dsa_upstream_port(chip->ds);
2312

2313 2314 2315 2316
	/* Upstream ports flood frames with unknown unicast or multicast DA */
	if (chip->info->ops->port_set_egress_floods)
		return chip->info->ops->port_set_egress_floods(chip, port,
							       flood, flood);
2317

2318
	return 0;
2319 2320
}

2321
static int mv88e6xxx_setup_port(struct mv88e6xxx_chip *chip, int port)
2322
{
2323
	struct dsa_switch *ds = chip->ds;
2324
	int err;
2325
	u16 reg;
2326

2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340
	/* MAC Forcing register: don't force link, speed, duplex or flow control
	 * state to any particular values on physical ports, but force the CPU
	 * port and all DSA ports to their maximum bandwidth and full duplex.
	 */
	if (dsa_is_cpu_port(ds, port) || dsa_is_dsa_port(ds, port))
		err = mv88e6xxx_port_setup_mac(chip, port, LINK_FORCED_UP,
					       SPEED_MAX, DUPLEX_FULL,
					       PHY_INTERFACE_MODE_NA);
	else
		err = mv88e6xxx_port_setup_mac(chip, port, LINK_UNFORCED,
					       SPEED_UNFORCED, DUPLEX_UNFORCED,
					       PHY_INTERFACE_MODE_NA);
	if (err)
		return err;
2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355

	/* Port Control: disable Drop-on-Unlock, disable Drop-on-Lock,
	 * disable Header mode, enable IGMP/MLD snooping, disable VLAN
	 * tunneling, determine priority by looking at 802.1p and IP
	 * priority fields (IP prio has precedence), and set STP state
	 * to Forwarding.
	 *
	 * If this is the CPU link, use DSA or EDSA tagging depending
	 * on which tagging mode was configured.
	 *
	 * If this is a link to another switch, use DSA tagging mode.
	 *
	 * If this is the upstream port for this switch, enable
	 * forwarding of unknown unicasts and multicasts.
	 */
2356
	reg = PORT_CONTROL_IGMP_MLD_SNOOP |
2357 2358
		PORT_CONTROL_USE_TAG | PORT_CONTROL_USE_IP |
		PORT_CONTROL_STATE_FORWARDING;
2359 2360 2361
	err = mv88e6xxx_port_write(chip, port, PORT_CONTROL, reg);
	if (err)
		return err;
2362

2363
	err = mv88e6xxx_setup_port_mode(chip, port);
2364 2365
	if (err)
		return err;
2366

2367
	err = mv88e6xxx_setup_egress_floods(chip, port);
2368 2369 2370
	if (err)
		return err;

2371 2372 2373
	/* If this port is connected to a SerDes, make sure the SerDes is not
	 * powered down.
	 */
2374
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAGS_SERDES)) {
2375 2376 2377 2378 2379 2380 2381 2382 2383 2384
		err = mv88e6xxx_port_read(chip, port, PORT_STATUS, &reg);
		if (err)
			return err;
		reg &= PORT_STATUS_CMODE_MASK;
		if ((reg == PORT_STATUS_CMODE_100BASE_X) ||
		    (reg == PORT_STATUS_CMODE_1000BASE_X) ||
		    (reg == PORT_STATUS_CMODE_SGMII)) {
			err = mv88e6xxx_serdes_power_on(chip);
			if (err < 0)
				return err;
2385 2386 2387
		}
	}

2388
	/* Port Control 2: don't force a good FCS, set the maximum frame size to
2389
	 * 10240 bytes, disable 802.1q tags checking, don't discard tagged or
2390 2391 2392
	 * untagged frames on this port, do a destination address lookup on all
	 * received packets as usual, disable ARP mirroring and don't send a
	 * copy of all transmitted/received frames on this port to the CPU.
2393
	 */
2394 2395 2396
	err = mv88e6xxx_port_set_map_da(chip, port);
	if (err)
		return err;
2397

2398 2399 2400 2401
	reg = 0;
	if (chip->info->ops->port_set_upstream_port) {
		err = chip->info->ops->port_set_upstream_port(
			chip, port, dsa_upstream_port(ds));
2402 2403
		if (err)
			return err;
2404 2405
	}

2406 2407 2408 2409 2410
	err = mv88e6xxx_port_set_8021q_mode(chip, port,
					    PORT_CONTROL_2_8021Q_DISABLED);
	if (err)
		return err;

2411 2412 2413 2414 2415 2416
	if (chip->info->ops->port_jumbo_config) {
		err = chip->info->ops->port_jumbo_config(chip, port);
		if (err)
			return err;
	}

2417 2418 2419 2420 2421
	/* Port Association Vector: when learning source addresses
	 * of packets, add the address to the address database using
	 * a port bitmap that has only the bit for this port set and
	 * the other bits clear.
	 */
2422
	reg = 1 << port;
2423 2424
	/* Disable learning for CPU port */
	if (dsa_is_cpu_port(ds, port))
2425
		reg = 0;
2426

2427 2428 2429
	err = mv88e6xxx_port_write(chip, port, PORT_ASSOC_VECTOR, reg);
	if (err)
		return err;
2430 2431

	/* Egress rate control 2: disable egress rate control. */
2432 2433 2434
	err = mv88e6xxx_port_write(chip, port, PORT_RATE_CONTROL_2, 0x0000);
	if (err)
		return err;
2435

2436 2437
	if (chip->info->ops->port_pause_config) {
		err = chip->info->ops->port_pause_config(chip, port);
2438 2439
		if (err)
			return err;
2440
	}
2441

2442 2443 2444 2445 2446 2447
	if (chip->info->ops->port_disable_learn_limit) {
		err = chip->info->ops->port_disable_learn_limit(chip, port);
		if (err)
			return err;
	}

2448 2449
	if (chip->info->ops->port_disable_pri_override) {
		err = chip->info->ops->port_disable_pri_override(chip, port);
2450 2451
		if (err)
			return err;
2452
	}
2453

2454 2455
	if (chip->info->ops->port_tag_remap) {
		err = chip->info->ops->port_tag_remap(chip, port);
2456 2457
		if (err)
			return err;
2458 2459
	}

2460 2461
	if (chip->info->ops->port_egress_rate_limiting) {
		err = chip->info->ops->port_egress_rate_limiting(chip, port);
2462 2463
		if (err)
			return err;
2464 2465
	}

2466
	err = mv88e6xxx_setup_message_port(chip, port);
2467 2468
	if (err)
		return err;
2469

2470
	/* Port based VLAN map: give each port the same default address
2471 2472
	 * database, and allow bidirectional communication between the
	 * CPU and DSA port(s), and the other ports.
2473
	 */
2474
	err = mv88e6xxx_port_set_fid(chip, port, 0);
2475 2476
	if (err)
		return err;
2477

2478 2479 2480
	err = _mv88e6xxx_port_based_vlan_map(chip, port);
	if (err)
		return err;
2481 2482 2483 2484

	/* Default VLAN ID and priority: don't set a default VLAN
	 * ID, and set the default packet priority to zero.
	 */
2485
	return mv88e6xxx_port_write(chip, port, PORT_DEFAULT_VLAN, 0x0000);
2486 2487
}

2488
static int mv88e6xxx_g1_set_switch_mac(struct mv88e6xxx_chip *chip, u8 *addr)
2489 2490 2491
{
	int err;

2492
	err = mv88e6xxx_g1_write(chip, GLOBAL_MAC_01, (addr[0] << 8) | addr[1]);
2493 2494 2495
	if (err)
		return err;

2496
	err = mv88e6xxx_g1_write(chip, GLOBAL_MAC_23, (addr[2] << 8) | addr[3]);
2497 2498 2499
	if (err)
		return err;

2500 2501 2502 2503 2504
	err = mv88e6xxx_g1_write(chip, GLOBAL_MAC_45, (addr[4] << 8) | addr[5]);
	if (err)
		return err;

	return 0;
2505 2506
}

2507 2508 2509
static int mv88e6xxx_set_ageing_time(struct dsa_switch *ds,
				     unsigned int ageing_time)
{
V
Vivien Didelot 已提交
2510
	struct mv88e6xxx_chip *chip = ds->priv;
2511 2512 2513
	int err;

	mutex_lock(&chip->reg_lock);
2514
	err = mv88e6xxx_g1_atu_set_age_time(chip, ageing_time);
2515 2516 2517 2518 2519
	mutex_unlock(&chip->reg_lock);

	return err;
}

2520
static int mv88e6xxx_g1_setup(struct mv88e6xxx_chip *chip)
2521
{
2522
	struct dsa_switch *ds = chip->ds;
2523
	u32 upstream_port = dsa_upstream_port(ds);
2524
	int err;
2525

2526 2527 2528
	/* Enable the PHY Polling Unit if present, don't discard any packets,
	 * and mask all interrupt sources.
	 */
2529
	err = mv88e6xxx_ppu_enable(chip);
2530 2531 2532
	if (err)
		return err;

2533 2534 2535 2536 2537 2538 2539 2540 2541 2542 2543
	if (chip->info->ops->g1_set_cpu_port) {
		err = chip->info->ops->g1_set_cpu_port(chip, upstream_port);
		if (err)
			return err;
	}

	if (chip->info->ops->g1_set_egress_port) {
		err = chip->info->ops->g1_set_egress_port(chip, upstream_port);
		if (err)
			return err;
	}
2544

2545
	/* Disable remote management, and set the switch's DSA device number. */
2546 2547 2548
	err = mv88e6xxx_g1_write(chip, GLOBAL_CONTROL_2,
				 GLOBAL_CONTROL_2_MULTIPLE_CASCADE |
				 (ds->index & 0x1f));
2549 2550 2551
	if (err)
		return err;

2552 2553 2554 2555 2556
	/* Clear all the VTU and STU entries */
	err = _mv88e6xxx_vtu_stu_flush(chip);
	if (err < 0)
		return err;

2557
	/* Configure the IP ToS mapping registers. */
2558
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_0, 0x0000);
2559
	if (err)
2560
		return err;
2561
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_1, 0x0000);
2562
	if (err)
2563
		return err;
2564
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_2, 0x5555);
2565
	if (err)
2566
		return err;
2567
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_3, 0x5555);
2568
	if (err)
2569
		return err;
2570
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_4, 0xaaaa);
2571
	if (err)
2572
		return err;
2573
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_5, 0xaaaa);
2574
	if (err)
2575
		return err;
2576
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_6, 0xffff);
2577
	if (err)
2578
		return err;
2579
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_7, 0xffff);
2580
	if (err)
2581
		return err;
2582 2583

	/* Configure the IEEE 802.1p priority mapping register. */
2584
	err = mv88e6xxx_g1_write(chip, GLOBAL_IEEE_PRI, 0xfa41);
2585
	if (err)
2586
		return err;
2587

2588 2589 2590 2591 2592
	/* Initialize the statistics unit */
	err = mv88e6xxx_stats_set_histogram(chip);
	if (err)
		return err;

2593
	/* Clear the statistics counters for all ports */
2594 2595
	err = mv88e6xxx_g1_write(chip, GLOBAL_STATS_OP,
				 GLOBAL_STATS_OP_FLUSH_ALL);
2596 2597 2598 2599
	if (err)
		return err;

	/* Wait for the flush to complete. */
2600
	err = mv88e6xxx_g1_stats_wait(chip);
2601 2602 2603 2604 2605 2606
	if (err)
		return err;

	return 0;
}

2607
static int mv88e6xxx_setup(struct dsa_switch *ds)
2608
{
V
Vivien Didelot 已提交
2609
	struct mv88e6xxx_chip *chip = ds->priv;
2610
	int err;
2611 2612
	int i;

2613
	chip->ds = ds;
2614
	ds->slave_mii_bus = mv88e6xxx_default_mdio_bus(chip);
2615

2616
	mutex_lock(&chip->reg_lock);
2617

2618
	/* Setup Switch Port Registers */
2619
	for (i = 0; i < mv88e6xxx_num_ports(chip); i++) {
2620 2621 2622 2623 2624 2625 2626
		err = mv88e6xxx_setup_port(chip, i);
		if (err)
			goto unlock;
	}

	/* Setup Switch Global 1 Registers */
	err = mv88e6xxx_g1_setup(chip);
2627 2628 2629
	if (err)
		goto unlock;

2630 2631 2632
	/* Setup Switch Global 2 Registers */
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_GLOBAL2)) {
		err = mv88e6xxx_g2_setup(chip);
2633 2634 2635
		if (err)
			goto unlock;
	}
2636

2637 2638 2639 2640
	err = mv88e6xxx_pvt_setup(chip);
	if (err)
		goto unlock;

2641 2642 2643 2644
	err = mv88e6xxx_atu_setup(chip);
	if (err)
		goto unlock;

2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655
	/* Some generations have the configuration of sending reserved
	 * management frames to the CPU in global2, others in
	 * global1. Hence it does not fit the two setup functions
	 * above.
	 */
	if (chip->info->ops->mgmt_rsvd2cpu) {
		err = chip->info->ops->mgmt_rsvd2cpu(chip);
		if (err)
			goto unlock;
	}

2656
unlock:
2657
	mutex_unlock(&chip->reg_lock);
2658

2659
	return err;
2660 2661
}

2662 2663
static int mv88e6xxx_set_addr(struct dsa_switch *ds, u8 *addr)
{
V
Vivien Didelot 已提交
2664
	struct mv88e6xxx_chip *chip = ds->priv;
2665 2666
	int err;

2667 2668
	if (!chip->info->ops->set_switch_mac)
		return -EOPNOTSUPP;
2669

2670 2671
	mutex_lock(&chip->reg_lock);
	err = chip->info->ops->set_switch_mac(chip, addr);
2672 2673 2674 2675 2676
	mutex_unlock(&chip->reg_lock);

	return err;
}

2677
static int mv88e6xxx_mdio_read(struct mii_bus *bus, int phy, int reg)
2678
{
2679 2680
	struct mv88e6xxx_mdio_bus *mdio_bus = bus->priv;
	struct mv88e6xxx_chip *chip = mdio_bus->chip;
2681 2682
	u16 val;
	int err;
2683

2684 2685 2686
	if (!chip->info->ops->phy_read)
		return -EOPNOTSUPP;

2687
	mutex_lock(&chip->reg_lock);
2688
	err = chip->info->ops->phy_read(chip, bus, phy, reg, &val);
2689
	mutex_unlock(&chip->reg_lock);
2690

2691 2692 2693 2694 2695 2696 2697 2698
	if (reg == MII_PHYSID2) {
		/* Some internal PHYS don't have a model number.  Use
		 * the mv88e6390 family model number instead.
		 */
		if (!(val & 0x3f0))
			val |= PORT_SWITCH_ID_PROD_NUM_6390;
	}

2699
	return err ? err : val;
2700 2701
}

2702
static int mv88e6xxx_mdio_write(struct mii_bus *bus, int phy, int reg, u16 val)
2703
{
2704 2705
	struct mv88e6xxx_mdio_bus *mdio_bus = bus->priv;
	struct mv88e6xxx_chip *chip = mdio_bus->chip;
2706
	int err;
2707

2708 2709 2710
	if (!chip->info->ops->phy_write)
		return -EOPNOTSUPP;

2711
	mutex_lock(&chip->reg_lock);
2712
	err = chip->info->ops->phy_write(chip, bus, phy, reg, val);
2713
	mutex_unlock(&chip->reg_lock);
2714 2715

	return err;
2716 2717
}

2718
static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip *chip,
2719 2720
				   struct device_node *np,
				   bool external)
2721 2722
{
	static int index;
2723
	struct mv88e6xxx_mdio_bus *mdio_bus;
2724 2725 2726
	struct mii_bus *bus;
	int err;

2727
	bus = devm_mdiobus_alloc_size(chip->dev, sizeof(*mdio_bus));
2728 2729 2730
	if (!bus)
		return -ENOMEM;

2731
	mdio_bus = bus->priv;
2732
	mdio_bus->bus = bus;
2733
	mdio_bus->chip = chip;
2734 2735
	INIT_LIST_HEAD(&mdio_bus->list);
	mdio_bus->external = external;
2736

2737 2738 2739 2740 2741 2742 2743 2744 2745 2746
	if (np) {
		bus->name = np->full_name;
		snprintf(bus->id, MII_BUS_ID_SIZE, "%s", np->full_name);
	} else {
		bus->name = "mv88e6xxx SMI";
		snprintf(bus->id, MII_BUS_ID_SIZE, "mv88e6xxx-%d", index++);
	}

	bus->read = mv88e6xxx_mdio_read;
	bus->write = mv88e6xxx_mdio_write;
2747
	bus->parent = chip->dev;
2748

2749 2750
	if (np)
		err = of_mdiobus_register(bus, np);
2751 2752 2753
	else
		err = mdiobus_register(bus);
	if (err) {
2754
		dev_err(chip->dev, "Cannot register MDIO bus (%d)\n", err);
2755
		return err;
2756
	}
2757 2758 2759 2760 2761

	if (external)
		list_add_tail(&mdio_bus->list, &chip->mdios);
	else
		list_add(&mdio_bus->list, &chip->mdios);
2762 2763

	return 0;
2764
}
2765

2766 2767 2768 2769 2770
static const struct of_device_id mv88e6xxx_mdio_external_match[] = {
	{ .compatible = "marvell,mv88e6xxx-mdio-external",
	  .data = (void *)true },
	{ },
};
2771

2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801
static int mv88e6xxx_mdios_register(struct mv88e6xxx_chip *chip,
				    struct device_node *np)
{
	const struct of_device_id *match;
	struct device_node *child;
	int err;

	/* Always register one mdio bus for the internal/default mdio
	 * bus. This maybe represented in the device tree, but is
	 * optional.
	 */
	child = of_get_child_by_name(np, "mdio");
	err = mv88e6xxx_mdio_register(chip, child, false);
	if (err)
		return err;

	/* Walk the device tree, and see if there are any other nodes
	 * which say they are compatible with the external mdio
	 * bus.
	 */
	for_each_available_child_of_node(np, child) {
		match = of_match_node(mv88e6xxx_mdio_external_match, child);
		if (match) {
			err = mv88e6xxx_mdio_register(chip, child, true);
			if (err)
				return err;
		}
	}

	return 0;
2802 2803
}

2804
static void mv88e6xxx_mdios_unregister(struct mv88e6xxx_chip *chip)
2805 2806

{
2807 2808
	struct mv88e6xxx_mdio_bus *mdio_bus;
	struct mii_bus *bus;
2809

2810 2811
	list_for_each_entry(mdio_bus, &chip->mdios, list) {
		bus = mdio_bus->bus;
2812

2813 2814
		mdiobus_unregister(bus);
	}
2815 2816
}

2817 2818
static int mv88e6xxx_get_eeprom_len(struct dsa_switch *ds)
{
V
Vivien Didelot 已提交
2819
	struct mv88e6xxx_chip *chip = ds->priv;
2820 2821 2822 2823 2824 2825 2826

	return chip->eeprom_len;
}

static int mv88e6xxx_get_eeprom(struct dsa_switch *ds,
				struct ethtool_eeprom *eeprom, u8 *data)
{
V
Vivien Didelot 已提交
2827
	struct mv88e6xxx_chip *chip = ds->priv;
2828 2829
	int err;

2830 2831
	if (!chip->info->ops->get_eeprom)
		return -EOPNOTSUPP;
2832

2833 2834
	mutex_lock(&chip->reg_lock);
	err = chip->info->ops->get_eeprom(chip, eeprom, data);
2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847
	mutex_unlock(&chip->reg_lock);

	if (err)
		return err;

	eeprom->magic = 0xc3ec4951;

	return 0;
}

static int mv88e6xxx_set_eeprom(struct dsa_switch *ds,
				struct ethtool_eeprom *eeprom, u8 *data)
{
V
Vivien Didelot 已提交
2848
	struct mv88e6xxx_chip *chip = ds->priv;
2849 2850
	int err;

2851 2852 2853
	if (!chip->info->ops->set_eeprom)
		return -EOPNOTSUPP;

2854 2855 2856 2857
	if (eeprom->magic != 0xc3ec4951)
		return -EINVAL;

	mutex_lock(&chip->reg_lock);
2858
	err = chip->info->ops->set_eeprom(chip, eeprom, data);
2859 2860 2861 2862 2863
	mutex_unlock(&chip->reg_lock);

	return err;
}

2864
static const struct mv88e6xxx_ops mv88e6085_ops = {
2865
	/* MV88E6XXX_FAMILY_6097 */
2866
	.set_switch_mac = mv88e6xxx_g1_set_switch_mac,
2867 2868
	.phy_read = mv88e6xxx_phy_ppu_read,
	.phy_write = mv88e6xxx_phy_ppu_write,
2869
	.port_set_link = mv88e6xxx_port_set_link,
2870
	.port_set_duplex = mv88e6xxx_port_set_duplex,
2871
	.port_set_speed = mv88e6185_port_set_speed,
2872
	.port_tag_remap = mv88e6095_port_tag_remap,
2873
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
2874
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
2875
	.port_set_ether_type = mv88e6351_port_set_ether_type,
2876
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
2877
	.port_pause_config = mv88e6097_port_pause_config,
2878
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
2879
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
2880
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
2881 2882
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
2883
	.stats_get_stats = mv88e6095_stats_get_stats,
2884 2885
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
2886
	.watchdog_ops = &mv88e6097_watchdog_ops,
2887
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
2888 2889
	.ppu_enable = mv88e6185_g1_ppu_enable,
	.ppu_disable = mv88e6185_g1_ppu_disable,
2890
	.reset = mv88e6185_g1_reset,
2891 2892 2893
};

static const struct mv88e6xxx_ops mv88e6095_ops = {
2894
	/* MV88E6XXX_FAMILY_6095 */
2895
	.set_switch_mac = mv88e6xxx_g1_set_switch_mac,
2896 2897
	.phy_read = mv88e6xxx_phy_ppu_read,
	.phy_write = mv88e6xxx_phy_ppu_write,
2898
	.port_set_link = mv88e6xxx_port_set_link,
2899
	.port_set_duplex = mv88e6xxx_port_set_duplex,
2900
	.port_set_speed = mv88e6185_port_set_speed,
2901
	.port_set_frame_mode = mv88e6085_port_set_frame_mode,
2902
	.port_set_egress_floods = mv88e6185_port_set_egress_floods,
2903
	.port_set_upstream_port = mv88e6095_port_set_upstream_port,
2904
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
2905 2906
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
2907
	.stats_get_stats = mv88e6095_stats_get_stats,
2908
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
2909 2910
	.ppu_enable = mv88e6185_g1_ppu_enable,
	.ppu_disable = mv88e6185_g1_ppu_disable,
2911
	.reset = mv88e6185_g1_reset,
2912 2913
};

2914
static const struct mv88e6xxx_ops mv88e6097_ops = {
2915
	/* MV88E6XXX_FAMILY_6097 */
2916 2917 2918 2919 2920 2921
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
	.port_set_link = mv88e6xxx_port_set_link,
	.port_set_duplex = mv88e6xxx_port_set_duplex,
	.port_set_speed = mv88e6185_port_set_speed,
2922
	.port_tag_remap = mv88e6095_port_tag_remap,
2923
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
2924
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
2925
	.port_set_ether_type = mv88e6351_port_set_ether_type,
2926
	.port_jumbo_config = mv88e6165_port_jumbo_config,
2927
	.port_egress_rate_limiting = mv88e6095_port_egress_rate_limiting,
2928
	.port_pause_config = mv88e6097_port_pause_config,
2929
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
2930
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
2931 2932 2933 2934
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
	.stats_get_stats = mv88e6095_stats_get_stats,
2935 2936
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
2937
	.watchdog_ops = &mv88e6097_watchdog_ops,
2938
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
2939
	.reset = mv88e6352_g1_reset,
2940 2941
};

2942
static const struct mv88e6xxx_ops mv88e6123_ops = {
2943
	/* MV88E6XXX_FAMILY_6165 */
2944
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
2945 2946
	.phy_read = mv88e6165_phy_read,
	.phy_write = mv88e6165_phy_write,
2947
	.port_set_link = mv88e6xxx_port_set_link,
2948
	.port_set_duplex = mv88e6xxx_port_set_duplex,
2949
	.port_set_speed = mv88e6185_port_set_speed,
2950
	.port_set_frame_mode = mv88e6085_port_set_frame_mode,
2951
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
2952
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
2953
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
2954
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
2955 2956
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
2957
	.stats_get_stats = mv88e6095_stats_get_stats,
2958 2959
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
2960
	.watchdog_ops = &mv88e6097_watchdog_ops,
2961
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
2962
	.reset = mv88e6352_g1_reset,
2963 2964 2965
};

static const struct mv88e6xxx_ops mv88e6131_ops = {
2966
	/* MV88E6XXX_FAMILY_6185 */
2967
	.set_switch_mac = mv88e6xxx_g1_set_switch_mac,
2968 2969
	.phy_read = mv88e6xxx_phy_ppu_read,
	.phy_write = mv88e6xxx_phy_ppu_write,
2970
	.port_set_link = mv88e6xxx_port_set_link,
2971
	.port_set_duplex = mv88e6xxx_port_set_duplex,
2972
	.port_set_speed = mv88e6185_port_set_speed,
2973
	.port_tag_remap = mv88e6095_port_tag_remap,
2974
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
2975
	.port_set_egress_floods = mv88e6185_port_set_egress_floods,
2976
	.port_set_ether_type = mv88e6351_port_set_ether_type,
2977
	.port_set_upstream_port = mv88e6095_port_set_upstream_port,
2978
	.port_jumbo_config = mv88e6165_port_jumbo_config,
2979
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
2980
	.port_pause_config = mv88e6097_port_pause_config,
2981
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
2982 2983
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
2984
	.stats_get_stats = mv88e6095_stats_get_stats,
2985 2986
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
2987
	.watchdog_ops = &mv88e6097_watchdog_ops,
2988
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
2989 2990
	.ppu_enable = mv88e6185_g1_ppu_enable,
	.ppu_disable = mv88e6185_g1_ppu_disable,
2991
	.reset = mv88e6185_g1_reset,
2992 2993
};

2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024
static const struct mv88e6xxx_ops mv88e6141_ops = {
	/* MV88E6XXX_FAMILY_6341 */
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
	.port_set_link = mv88e6xxx_port_set_link,
	.port_set_duplex = mv88e6xxx_port_set_duplex,
	.port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
	.port_set_speed = mv88e6390_port_set_speed,
	.port_tag_remap = mv88e6095_port_tag_remap,
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
	.port_jumbo_config = mv88e6165_port_jumbo_config,
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
	.port_pause_config = mv88e6097_port_pause_config,
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
	.stats_get_stats = mv88e6390_stats_get_stats,
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
	.watchdog_ops = &mv88e6390_watchdog_ops,
	.mgmt_rsvd2cpu =  mv88e6390_g1_mgmt_rsvd2cpu,
	.reset = mv88e6352_g1_reset,
};

3025
static const struct mv88e6xxx_ops mv88e6161_ops = {
3026
	/* MV88E6XXX_FAMILY_6165 */
3027
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3028 3029
	.phy_read = mv88e6165_phy_read,
	.phy_write = mv88e6165_phy_write,
3030
	.port_set_link = mv88e6xxx_port_set_link,
3031
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3032
	.port_set_speed = mv88e6185_port_set_speed,
3033
	.port_tag_remap = mv88e6095_port_tag_remap,
3034
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3035
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3036
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3037
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3038
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3039
	.port_pause_config = mv88e6097_port_pause_config,
3040
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3041
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3042
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
3043 3044
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3045
	.stats_get_stats = mv88e6095_stats_get_stats,
3046 3047
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3048
	.watchdog_ops = &mv88e6097_watchdog_ops,
3049
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3050
	.reset = mv88e6352_g1_reset,
3051 3052 3053
};

static const struct mv88e6xxx_ops mv88e6165_ops = {
3054
	/* MV88E6XXX_FAMILY_6165 */
3055
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3056 3057
	.phy_read = mv88e6165_phy_read,
	.phy_write = mv88e6165_phy_write,
3058
	.port_set_link = mv88e6xxx_port_set_link,
3059
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3060
	.port_set_speed = mv88e6185_port_set_speed,
3061
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3062
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3063
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
3064 3065
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3066
	.stats_get_stats = mv88e6095_stats_get_stats,
3067 3068
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3069
	.watchdog_ops = &mv88e6097_watchdog_ops,
3070
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3071
	.reset = mv88e6352_g1_reset,
3072 3073 3074
};

static const struct mv88e6xxx_ops mv88e6171_ops = {
3075
	/* MV88E6XXX_FAMILY_6351 */
3076
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3077 3078
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3079
	.port_set_link = mv88e6xxx_port_set_link,
3080
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3081
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3082
	.port_set_speed = mv88e6185_port_set_speed,
3083
	.port_tag_remap = mv88e6095_port_tag_remap,
3084
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3085
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3086
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3087
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3088
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3089
	.port_pause_config = mv88e6097_port_pause_config,
3090
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3091
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3092
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3093 3094
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3095
	.stats_get_stats = mv88e6095_stats_get_stats,
3096 3097
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3098
	.watchdog_ops = &mv88e6097_watchdog_ops,
3099
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3100
	.reset = mv88e6352_g1_reset,
3101 3102 3103
};

static const struct mv88e6xxx_ops mv88e6172_ops = {
3104
	/* MV88E6XXX_FAMILY_6352 */
3105 3106
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3107
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3108 3109
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3110
	.port_set_link = mv88e6xxx_port_set_link,
3111
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3112
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3113
	.port_set_speed = mv88e6352_port_set_speed,
3114
	.port_tag_remap = mv88e6095_port_tag_remap,
3115
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3116
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3117
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3118
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3119
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3120
	.port_pause_config = mv88e6097_port_pause_config,
3121
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3122
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3123
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3124 3125
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3126
	.stats_get_stats = mv88e6095_stats_get_stats,
3127 3128
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3129
	.watchdog_ops = &mv88e6097_watchdog_ops,
3130
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3131
	.reset = mv88e6352_g1_reset,
3132 3133 3134
};

static const struct mv88e6xxx_ops mv88e6175_ops = {
3135
	/* MV88E6XXX_FAMILY_6351 */
3136
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3137 3138
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3139
	.port_set_link = mv88e6xxx_port_set_link,
3140
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3141
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3142
	.port_set_speed = mv88e6185_port_set_speed,
3143
	.port_tag_remap = mv88e6095_port_tag_remap,
3144
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3145
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3146
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3147
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3148
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3149
	.port_pause_config = mv88e6097_port_pause_config,
3150
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3151
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3152
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3153 3154
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3155
	.stats_get_stats = mv88e6095_stats_get_stats,
3156 3157
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3158
	.watchdog_ops = &mv88e6097_watchdog_ops,
3159
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3160
	.reset = mv88e6352_g1_reset,
3161 3162 3163
};

static const struct mv88e6xxx_ops mv88e6176_ops = {
3164
	/* MV88E6XXX_FAMILY_6352 */
3165 3166
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3167
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3168 3169
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3170
	.port_set_link = mv88e6xxx_port_set_link,
3171
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3172
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3173
	.port_set_speed = mv88e6352_port_set_speed,
3174
	.port_tag_remap = mv88e6095_port_tag_remap,
3175
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3176
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3177
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3178
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3179
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3180
	.port_pause_config = mv88e6097_port_pause_config,
3181
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3182
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3183
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3184 3185
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3186
	.stats_get_stats = mv88e6095_stats_get_stats,
3187 3188
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3189
	.watchdog_ops = &mv88e6097_watchdog_ops,
3190
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3191
	.reset = mv88e6352_g1_reset,
3192 3193 3194
};

static const struct mv88e6xxx_ops mv88e6185_ops = {
3195
	/* MV88E6XXX_FAMILY_6185 */
3196
	.set_switch_mac = mv88e6xxx_g1_set_switch_mac,
3197 3198
	.phy_read = mv88e6xxx_phy_ppu_read,
	.phy_write = mv88e6xxx_phy_ppu_write,
3199
	.port_set_link = mv88e6xxx_port_set_link,
3200
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3201
	.port_set_speed = mv88e6185_port_set_speed,
3202
	.port_set_frame_mode = mv88e6085_port_set_frame_mode,
3203
	.port_set_egress_floods = mv88e6185_port_set_egress_floods,
3204
	.port_egress_rate_limiting = mv88e6095_port_egress_rate_limiting,
3205
	.port_set_upstream_port = mv88e6095_port_set_upstream_port,
3206
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
3207 3208
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3209
	.stats_get_stats = mv88e6095_stats_get_stats,
3210 3211
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3212
	.watchdog_ops = &mv88e6097_watchdog_ops,
3213
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3214 3215
	.ppu_enable = mv88e6185_g1_ppu_enable,
	.ppu_disable = mv88e6185_g1_ppu_disable,
3216
	.reset = mv88e6185_g1_reset,
3217 3218
};

3219
static const struct mv88e6xxx_ops mv88e6190_ops = {
3220
	/* MV88E6XXX_FAMILY_6390 */
3221 3222
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3223 3224 3225 3226 3227 3228 3229
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
	.port_set_link = mv88e6xxx_port_set_link,
	.port_set_duplex = mv88e6xxx_port_set_duplex,
	.port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
	.port_set_speed = mv88e6390_port_set_speed,
3230
	.port_tag_remap = mv88e6390_port_tag_remap,
3231
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3232
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3233
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3234
	.port_pause_config = mv88e6390_port_pause_config,
3235
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3236
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3237
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3238
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3239 3240
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3241
	.stats_get_stats = mv88e6390_stats_get_stats,
3242 3243
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3244
	.watchdog_ops = &mv88e6390_watchdog_ops,
3245
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3246
	.reset = mv88e6352_g1_reset,
3247 3248 3249
};

static const struct mv88e6xxx_ops mv88e6190x_ops = {
3250
	/* MV88E6XXX_FAMILY_6390 */
3251 3252
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3253 3254 3255 3256 3257 3258 3259
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
	.port_set_link = mv88e6xxx_port_set_link,
	.port_set_duplex = mv88e6xxx_port_set_duplex,
	.port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
	.port_set_speed = mv88e6390x_port_set_speed,
3260
	.port_tag_remap = mv88e6390_port_tag_remap,
3261
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3262
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3263
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3264
	.port_pause_config = mv88e6390_port_pause_config,
3265
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3266
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3267
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3268
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3269 3270
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3271
	.stats_get_stats = mv88e6390_stats_get_stats,
3272 3273
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3274
	.watchdog_ops = &mv88e6390_watchdog_ops,
3275
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3276
	.reset = mv88e6352_g1_reset,
3277 3278 3279
};

static const struct mv88e6xxx_ops mv88e6191_ops = {
3280
	/* MV88E6XXX_FAMILY_6390 */
3281 3282
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3283 3284 3285 3286 3287 3288 3289
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
	.port_set_link = mv88e6xxx_port_set_link,
	.port_set_duplex = mv88e6xxx_port_set_duplex,
	.port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
	.port_set_speed = mv88e6390_port_set_speed,
3290
	.port_tag_remap = mv88e6390_port_tag_remap,
3291
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3292
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3293
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3294
	.port_pause_config = mv88e6390_port_pause_config,
3295
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3296
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3297
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3298
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3299 3300
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3301
	.stats_get_stats = mv88e6390_stats_get_stats,
3302 3303
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3304
	.watchdog_ops = &mv88e6390_watchdog_ops,
3305
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3306
	.reset = mv88e6352_g1_reset,
3307 3308
};

3309
static const struct mv88e6xxx_ops mv88e6240_ops = {
3310
	/* MV88E6XXX_FAMILY_6352 */
3311 3312
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3313
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3314 3315
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3316
	.port_set_link = mv88e6xxx_port_set_link,
3317
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3318
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3319
	.port_set_speed = mv88e6352_port_set_speed,
3320
	.port_tag_remap = mv88e6095_port_tag_remap,
3321
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3322
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3323
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3324
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3325
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3326
	.port_pause_config = mv88e6097_port_pause_config,
3327
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3328
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3329
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3330 3331
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3332
	.stats_get_stats = mv88e6095_stats_get_stats,
3333 3334
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3335
	.watchdog_ops = &mv88e6097_watchdog_ops,
3336
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3337
	.reset = mv88e6352_g1_reset,
3338 3339
};

3340
static const struct mv88e6xxx_ops mv88e6290_ops = {
3341
	/* MV88E6XXX_FAMILY_6390 */
3342 3343
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3344 3345 3346 3347 3348 3349 3350
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
	.port_set_link = mv88e6xxx_port_set_link,
	.port_set_duplex = mv88e6xxx_port_set_duplex,
	.port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
	.port_set_speed = mv88e6390_port_set_speed,
3351
	.port_tag_remap = mv88e6390_port_tag_remap,
3352
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3353
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3354
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3355
	.port_pause_config = mv88e6390_port_pause_config,
3356
	.port_set_cmode = mv88e6390x_port_set_cmode,
3357
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3358
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3359
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3360
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3361 3362
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3363
	.stats_get_stats = mv88e6390_stats_get_stats,
3364 3365
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3366
	.watchdog_ops = &mv88e6390_watchdog_ops,
3367
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3368
	.reset = mv88e6352_g1_reset,
3369 3370
};

3371
static const struct mv88e6xxx_ops mv88e6320_ops = {
3372
	/* MV88E6XXX_FAMILY_6320 */
3373 3374
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3375
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3376 3377
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3378
	.port_set_link = mv88e6xxx_port_set_link,
3379
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3380
	.port_set_speed = mv88e6185_port_set_speed,
3381
	.port_tag_remap = mv88e6095_port_tag_remap,
3382
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3383
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3384
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3385
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3386
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3387
	.port_pause_config = mv88e6097_port_pause_config,
3388
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3389
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3390
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3391 3392
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3393
	.stats_get_stats = mv88e6320_stats_get_stats,
3394 3395
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3396
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3397
	.reset = mv88e6352_g1_reset,
3398 3399 3400
};

static const struct mv88e6xxx_ops mv88e6321_ops = {
3401
	/* MV88E6XXX_FAMILY_6321 */
3402 3403
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3404
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3405 3406
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3407
	.port_set_link = mv88e6xxx_port_set_link,
3408
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3409
	.port_set_speed = mv88e6185_port_set_speed,
3410
	.port_tag_remap = mv88e6095_port_tag_remap,
3411
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3412
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3413
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3414
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3415
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3416
	.port_pause_config = mv88e6097_port_pause_config,
3417
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3418
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3419
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3420 3421
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3422
	.stats_get_stats = mv88e6320_stats_get_stats,
3423 3424
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3425
	.reset = mv88e6352_g1_reset,
3426 3427
};

3428 3429 3430 3431 3432 3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449 3450 3451 3452 3453 3454 3455 3456 3457 3458
static const struct mv88e6xxx_ops mv88e6341_ops = {
	/* MV88E6XXX_FAMILY_6341 */
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
	.port_set_link = mv88e6xxx_port_set_link,
	.port_set_duplex = mv88e6xxx_port_set_duplex,
	.port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
	.port_set_speed = mv88e6390_port_set_speed,
	.port_tag_remap = mv88e6095_port_tag_remap,
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
	.port_jumbo_config = mv88e6165_port_jumbo_config,
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
	.port_pause_config = mv88e6097_port_pause_config,
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
	.stats_get_stats = mv88e6390_stats_get_stats,
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
	.watchdog_ops = &mv88e6390_watchdog_ops,
	.mgmt_rsvd2cpu =  mv88e6390_g1_mgmt_rsvd2cpu,
	.reset = mv88e6352_g1_reset,
};

3459
static const struct mv88e6xxx_ops mv88e6350_ops = {
3460
	/* MV88E6XXX_FAMILY_6351 */
3461
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3462 3463
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3464
	.port_set_link = mv88e6xxx_port_set_link,
3465
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3466
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3467
	.port_set_speed = mv88e6185_port_set_speed,
3468
	.port_tag_remap = mv88e6095_port_tag_remap,
3469
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3470
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3471
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3472
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3473
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3474
	.port_pause_config = mv88e6097_port_pause_config,
3475
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3476
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3477
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3478 3479
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3480
	.stats_get_stats = mv88e6095_stats_get_stats,
3481 3482
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3483
	.watchdog_ops = &mv88e6097_watchdog_ops,
3484
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3485
	.reset = mv88e6352_g1_reset,
3486 3487 3488
};

static const struct mv88e6xxx_ops mv88e6351_ops = {
3489
	/* MV88E6XXX_FAMILY_6351 */
3490
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3491 3492
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3493
	.port_set_link = mv88e6xxx_port_set_link,
3494
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3495
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3496
	.port_set_speed = mv88e6185_port_set_speed,
3497
	.port_tag_remap = mv88e6095_port_tag_remap,
3498
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3499
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3500
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3501
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3502
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3503
	.port_pause_config = mv88e6097_port_pause_config,
3504
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3505
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3506
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3507 3508
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3509
	.stats_get_stats = mv88e6095_stats_get_stats,
3510 3511
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3512
	.watchdog_ops = &mv88e6097_watchdog_ops,
3513
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3514
	.reset = mv88e6352_g1_reset,
3515 3516 3517
};

static const struct mv88e6xxx_ops mv88e6352_ops = {
3518
	/* MV88E6XXX_FAMILY_6352 */
3519 3520
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3521
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3522 3523
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3524
	.port_set_link = mv88e6xxx_port_set_link,
3525
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3526
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3527
	.port_set_speed = mv88e6352_port_set_speed,
3528
	.port_tag_remap = mv88e6095_port_tag_remap,
3529
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3530
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3531
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3532
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3533
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3534
	.port_pause_config = mv88e6097_port_pause_config,
3535
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3536
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3537
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3538 3539
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3540
	.stats_get_stats = mv88e6095_stats_get_stats,
3541 3542
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3543
	.watchdog_ops = &mv88e6097_watchdog_ops,
3544
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3545
	.reset = mv88e6352_g1_reset,
3546 3547
};

3548
static const struct mv88e6xxx_ops mv88e6390_ops = {
3549
	/* MV88E6XXX_FAMILY_6390 */
3550 3551
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3552 3553 3554 3555 3556 3557 3558
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
	.port_set_link = mv88e6xxx_port_set_link,
	.port_set_duplex = mv88e6xxx_port_set_duplex,
	.port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
	.port_set_speed = mv88e6390_port_set_speed,
3559
	.port_tag_remap = mv88e6390_port_tag_remap,
3560
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3561
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3562
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3563
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3564
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3565
	.port_pause_config = mv88e6390_port_pause_config,
3566
	.port_set_cmode = mv88e6390x_port_set_cmode,
3567
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3568
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3569
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3570
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3571 3572
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3573
	.stats_get_stats = mv88e6390_stats_get_stats,
3574 3575
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3576
	.watchdog_ops = &mv88e6390_watchdog_ops,
3577
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3578
	.reset = mv88e6352_g1_reset,
3579 3580 3581
};

static const struct mv88e6xxx_ops mv88e6390x_ops = {
3582
	/* MV88E6XXX_FAMILY_6390 */
3583 3584
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3585 3586 3587 3588 3589 3590 3591
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
	.port_set_link = mv88e6xxx_port_set_link,
	.port_set_duplex = mv88e6xxx_port_set_duplex,
	.port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
	.port_set_speed = mv88e6390x_port_set_speed,
3592
	.port_tag_remap = mv88e6390_port_tag_remap,
3593
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3594
	.port_set_egress_floods = mv88e6352_port_set_egress_floods,
3595
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3596
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3597
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3598
	.port_pause_config = mv88e6390_port_pause_config,
3599
	.port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
3600
	.port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
3601
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3602
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3603 3604
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3605
	.stats_get_stats = mv88e6390_stats_get_stats,
3606 3607
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3608
	.watchdog_ops = &mv88e6390_watchdog_ops,
3609
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3610
	.reset = mv88e6352_g1_reset,
3611 3612
};

3613 3614 3615 3616 3617 3618 3619
static const struct mv88e6xxx_info mv88e6xxx_table[] = {
	[MV88E6085] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6085,
		.family = MV88E6XXX_FAMILY_6097,
		.name = "Marvell 88E6085",
		.num_databases = 4096,
		.num_ports = 10,
3620
		.port_base_addr = 0x10,
3621
		.global1_addr = 0x1b,
3622
		.age_time_coeff = 15000,
3623
		.g1_irqs = 8,
3624
		.atu_move_port_mask = 0xf,
3625
		.pvt = true,
3626
		.tag_protocol = DSA_TAG_PROTO_DSA,
3627
		.flags = MV88E6XXX_FLAGS_FAMILY_6097,
3628
		.ops = &mv88e6085_ops,
3629 3630 3631 3632 3633 3634 3635 3636
	},

	[MV88E6095] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6095,
		.family = MV88E6XXX_FAMILY_6095,
		.name = "Marvell 88E6095/88E6095F",
		.num_databases = 256,
		.num_ports = 11,
3637
		.port_base_addr = 0x10,
3638
		.global1_addr = 0x1b,
3639
		.age_time_coeff = 15000,
3640
		.g1_irqs = 8,
3641
		.atu_move_port_mask = 0xf,
3642
		.tag_protocol = DSA_TAG_PROTO_DSA,
3643
		.flags = MV88E6XXX_FLAGS_FAMILY_6095,
3644
		.ops = &mv88e6095_ops,
3645 3646
	},

3647 3648 3649 3650 3651 3652 3653 3654 3655
	[MV88E6097] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6097,
		.family = MV88E6XXX_FAMILY_6097,
		.name = "Marvell 88E6097/88E6097F",
		.num_databases = 4096,
		.num_ports = 11,
		.port_base_addr = 0x10,
		.global1_addr = 0x1b,
		.age_time_coeff = 15000,
3656
		.g1_irqs = 8,
3657
		.atu_move_port_mask = 0xf,
3658
		.pvt = true,
3659
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3660 3661 3662 3663
		.flags = MV88E6XXX_FLAGS_FAMILY_6097,
		.ops = &mv88e6097_ops,
	},

3664 3665 3666 3667 3668 3669
	[MV88E6123] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6123,
		.family = MV88E6XXX_FAMILY_6165,
		.name = "Marvell 88E6123",
		.num_databases = 4096,
		.num_ports = 3,
3670
		.port_base_addr = 0x10,
3671
		.global1_addr = 0x1b,
3672
		.age_time_coeff = 15000,
3673
		.g1_irqs = 9,
3674
		.atu_move_port_mask = 0xf,
3675
		.pvt = true,
3676
		.tag_protocol = DSA_TAG_PROTO_DSA,
3677
		.flags = MV88E6XXX_FLAGS_FAMILY_6165,
3678
		.ops = &mv88e6123_ops,
3679 3680 3681 3682 3683 3684 3685 3686
	},

	[MV88E6131] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6131,
		.family = MV88E6XXX_FAMILY_6185,
		.name = "Marvell 88E6131",
		.num_databases = 256,
		.num_ports = 8,
3687
		.port_base_addr = 0x10,
3688
		.global1_addr = 0x1b,
3689
		.age_time_coeff = 15000,
3690
		.g1_irqs = 9,
3691
		.atu_move_port_mask = 0xf,
3692
		.tag_protocol = DSA_TAG_PROTO_DSA,
3693
		.flags = MV88E6XXX_FLAGS_FAMILY_6185,
3694
		.ops = &mv88e6131_ops,
3695 3696
	},

3697 3698 3699 3700 3701 3702 3703 3704 3705 3706
	[MV88E6141] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6141,
		.family = MV88E6XXX_FAMILY_6341,
		.name = "Marvell 88E6341",
		.num_databases = 4096,
		.num_ports = 6,
		.port_base_addr = 0x10,
		.global1_addr = 0x1b,
		.age_time_coeff = 3750,
		.atu_move_port_mask = 0x1f,
3707
		.pvt = true,
3708 3709 3710 3711 3712
		.tag_protocol = DSA_TAG_PROTO_EDSA,
		.flags = MV88E6XXX_FLAGS_FAMILY_6341,
		.ops = &mv88e6141_ops,
	},

3713 3714 3715 3716 3717 3718
	[MV88E6161] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6161,
		.family = MV88E6XXX_FAMILY_6165,
		.name = "Marvell 88E6161",
		.num_databases = 4096,
		.num_ports = 6,
3719
		.port_base_addr = 0x10,
3720
		.global1_addr = 0x1b,
3721
		.age_time_coeff = 15000,
3722
		.g1_irqs = 9,
3723
		.atu_move_port_mask = 0xf,
3724
		.pvt = true,
3725
		.tag_protocol = DSA_TAG_PROTO_DSA,
3726
		.flags = MV88E6XXX_FLAGS_FAMILY_6165,
3727
		.ops = &mv88e6161_ops,
3728 3729 3730 3731 3732 3733 3734 3735
	},

	[MV88E6165] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6165,
		.family = MV88E6XXX_FAMILY_6165,
		.name = "Marvell 88E6165",
		.num_databases = 4096,
		.num_ports = 6,
3736
		.port_base_addr = 0x10,
3737
		.global1_addr = 0x1b,
3738
		.age_time_coeff = 15000,
3739
		.g1_irqs = 9,
3740
		.atu_move_port_mask = 0xf,
3741
		.pvt = true,
3742
		.tag_protocol = DSA_TAG_PROTO_DSA,
3743
		.flags = MV88E6XXX_FLAGS_FAMILY_6165,
3744
		.ops = &mv88e6165_ops,
3745 3746 3747 3748 3749 3750 3751 3752
	},

	[MV88E6171] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6171,
		.family = MV88E6XXX_FAMILY_6351,
		.name = "Marvell 88E6171",
		.num_databases = 4096,
		.num_ports = 7,
3753
		.port_base_addr = 0x10,
3754
		.global1_addr = 0x1b,
3755
		.age_time_coeff = 15000,
3756
		.g1_irqs = 9,
3757
		.atu_move_port_mask = 0xf,
3758
		.pvt = true,
3759
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3760
		.flags = MV88E6XXX_FLAGS_FAMILY_6351,
3761
		.ops = &mv88e6171_ops,
3762 3763 3764 3765 3766 3767 3768 3769
	},

	[MV88E6172] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6172,
		.family = MV88E6XXX_FAMILY_6352,
		.name = "Marvell 88E6172",
		.num_databases = 4096,
		.num_ports = 7,
3770
		.port_base_addr = 0x10,
3771
		.global1_addr = 0x1b,
3772
		.age_time_coeff = 15000,
3773
		.g1_irqs = 9,
3774
		.atu_move_port_mask = 0xf,
3775
		.pvt = true,
3776
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3777
		.flags = MV88E6XXX_FLAGS_FAMILY_6352,
3778
		.ops = &mv88e6172_ops,
3779 3780 3781 3782 3783 3784 3785 3786
	},

	[MV88E6175] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6175,
		.family = MV88E6XXX_FAMILY_6351,
		.name = "Marvell 88E6175",
		.num_databases = 4096,
		.num_ports = 7,
3787
		.port_base_addr = 0x10,
3788
		.global1_addr = 0x1b,
3789
		.age_time_coeff = 15000,
3790
		.g1_irqs = 9,
3791
		.atu_move_port_mask = 0xf,
3792
		.pvt = true,
3793
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3794
		.flags = MV88E6XXX_FLAGS_FAMILY_6351,
3795
		.ops = &mv88e6175_ops,
3796 3797 3798 3799 3800 3801 3802 3803
	},

	[MV88E6176] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6176,
		.family = MV88E6XXX_FAMILY_6352,
		.name = "Marvell 88E6176",
		.num_databases = 4096,
		.num_ports = 7,
3804
		.port_base_addr = 0x10,
3805
		.global1_addr = 0x1b,
3806
		.age_time_coeff = 15000,
3807
		.g1_irqs = 9,
3808
		.atu_move_port_mask = 0xf,
3809
		.pvt = true,
3810
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3811
		.flags = MV88E6XXX_FLAGS_FAMILY_6352,
3812
		.ops = &mv88e6176_ops,
3813 3814 3815 3816 3817 3818 3819 3820
	},

	[MV88E6185] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6185,
		.family = MV88E6XXX_FAMILY_6185,
		.name = "Marvell 88E6185",
		.num_databases = 256,
		.num_ports = 10,
3821
		.port_base_addr = 0x10,
3822
		.global1_addr = 0x1b,
3823
		.age_time_coeff = 15000,
3824
		.g1_irqs = 8,
3825
		.atu_move_port_mask = 0xf,
3826
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3827
		.flags = MV88E6XXX_FLAGS_FAMILY_6185,
3828
		.ops = &mv88e6185_ops,
3829 3830
	},

3831 3832 3833 3834 3835 3836 3837 3838
	[MV88E6190] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6190,
		.family = MV88E6XXX_FAMILY_6390,
		.name = "Marvell 88E6190",
		.num_databases = 4096,
		.num_ports = 11,	/* 10 + Z80 */
		.port_base_addr = 0x0,
		.global1_addr = 0x1b,
3839
		.tag_protocol = DSA_TAG_PROTO_DSA,
3840
		.age_time_coeff = 3750,
3841
		.g1_irqs = 9,
3842
		.pvt = true,
3843
		.atu_move_port_mask = 0x1f,
3844 3845 3846 3847 3848 3849 3850 3851 3852 3853 3854 3855
		.flags = MV88E6XXX_FLAGS_FAMILY_6390,
		.ops = &mv88e6190_ops,
	},

	[MV88E6190X] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6190X,
		.family = MV88E6XXX_FAMILY_6390,
		.name = "Marvell 88E6190X",
		.num_databases = 4096,
		.num_ports = 11,	/* 10 + Z80 */
		.port_base_addr = 0x0,
		.global1_addr = 0x1b,
3856
		.age_time_coeff = 3750,
3857
		.g1_irqs = 9,
3858
		.atu_move_port_mask = 0x1f,
3859
		.pvt = true,
3860
		.tag_protocol = DSA_TAG_PROTO_DSA,
3861 3862 3863 3864 3865 3866 3867 3868 3869 3870 3871 3872
		.flags = MV88E6XXX_FLAGS_FAMILY_6390,
		.ops = &mv88e6190x_ops,
	},

	[MV88E6191] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6191,
		.family = MV88E6XXX_FAMILY_6390,
		.name = "Marvell 88E6191",
		.num_databases = 4096,
		.num_ports = 11,	/* 10 + Z80 */
		.port_base_addr = 0x0,
		.global1_addr = 0x1b,
3873
		.age_time_coeff = 3750,
3874
		.g1_irqs = 9,
3875
		.atu_move_port_mask = 0x1f,
3876
		.pvt = true,
3877
		.tag_protocol = DSA_TAG_PROTO_DSA,
3878
		.flags = MV88E6XXX_FLAGS_FAMILY_6390,
3879
		.ops = &mv88e6191_ops,
3880 3881
	},

3882 3883 3884 3885 3886 3887
	[MV88E6240] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6240,
		.family = MV88E6XXX_FAMILY_6352,
		.name = "Marvell 88E6240",
		.num_databases = 4096,
		.num_ports = 7,
3888
		.port_base_addr = 0x10,
3889
		.global1_addr = 0x1b,
3890
		.age_time_coeff = 15000,
3891
		.g1_irqs = 9,
3892
		.atu_move_port_mask = 0xf,
3893
		.pvt = true,
3894
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3895
		.flags = MV88E6XXX_FLAGS_FAMILY_6352,
3896
		.ops = &mv88e6240_ops,
3897 3898
	},

3899 3900 3901 3902 3903 3904 3905 3906
	[MV88E6290] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6290,
		.family = MV88E6XXX_FAMILY_6390,
		.name = "Marvell 88E6290",
		.num_databases = 4096,
		.num_ports = 11,	/* 10 + Z80 */
		.port_base_addr = 0x0,
		.global1_addr = 0x1b,
3907
		.age_time_coeff = 3750,
3908
		.g1_irqs = 9,
3909
		.atu_move_port_mask = 0x1f,
3910
		.pvt = true,
3911
		.tag_protocol = DSA_TAG_PROTO_DSA,
3912 3913 3914 3915
		.flags = MV88E6XXX_FLAGS_FAMILY_6390,
		.ops = &mv88e6290_ops,
	},

3916 3917 3918 3919 3920 3921
	[MV88E6320] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6320,
		.family = MV88E6XXX_FAMILY_6320,
		.name = "Marvell 88E6320",
		.num_databases = 4096,
		.num_ports = 7,
3922
		.port_base_addr = 0x10,
3923
		.global1_addr = 0x1b,
3924
		.age_time_coeff = 15000,
3925
		.g1_irqs = 8,
3926
		.atu_move_port_mask = 0xf,
3927
		.pvt = true,
3928
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3929
		.flags = MV88E6XXX_FLAGS_FAMILY_6320,
3930
		.ops = &mv88e6320_ops,
3931 3932 3933 3934 3935 3936 3937 3938
	},

	[MV88E6321] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6321,
		.family = MV88E6XXX_FAMILY_6320,
		.name = "Marvell 88E6321",
		.num_databases = 4096,
		.num_ports = 7,
3939
		.port_base_addr = 0x10,
3940
		.global1_addr = 0x1b,
3941
		.age_time_coeff = 15000,
3942
		.g1_irqs = 8,
3943
		.atu_move_port_mask = 0xf,
3944
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3945
		.flags = MV88E6XXX_FLAGS_FAMILY_6320,
3946
		.ops = &mv88e6321_ops,
3947 3948
	},

3949 3950 3951 3952 3953 3954 3955 3956 3957
	[MV88E6341] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6341,
		.family = MV88E6XXX_FAMILY_6341,
		.name = "Marvell 88E6341",
		.num_databases = 4096,
		.num_ports = 6,
		.port_base_addr = 0x10,
		.global1_addr = 0x1b,
		.age_time_coeff = 3750,
3958
		.atu_move_port_mask = 0x1f,
3959
		.pvt = true,
3960 3961 3962 3963 3964
		.tag_protocol = DSA_TAG_PROTO_EDSA,
		.flags = MV88E6XXX_FLAGS_FAMILY_6341,
		.ops = &mv88e6341_ops,
	},

3965 3966 3967 3968 3969 3970
	[MV88E6350] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6350,
		.family = MV88E6XXX_FAMILY_6351,
		.name = "Marvell 88E6350",
		.num_databases = 4096,
		.num_ports = 7,
3971
		.port_base_addr = 0x10,
3972
		.global1_addr = 0x1b,
3973
		.age_time_coeff = 15000,
3974
		.g1_irqs = 9,
3975
		.atu_move_port_mask = 0xf,
3976
		.pvt = true,
3977
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3978
		.flags = MV88E6XXX_FLAGS_FAMILY_6351,
3979
		.ops = &mv88e6350_ops,
3980 3981 3982 3983 3984 3985 3986 3987
	},

	[MV88E6351] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6351,
		.family = MV88E6XXX_FAMILY_6351,
		.name = "Marvell 88E6351",
		.num_databases = 4096,
		.num_ports = 7,
3988
		.port_base_addr = 0x10,
3989
		.global1_addr = 0x1b,
3990
		.age_time_coeff = 15000,
3991
		.g1_irqs = 9,
3992
		.atu_move_port_mask = 0xf,
3993
		.pvt = true,
3994
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3995
		.flags = MV88E6XXX_FLAGS_FAMILY_6351,
3996
		.ops = &mv88e6351_ops,
3997 3998 3999 4000 4001 4002 4003 4004
	},

	[MV88E6352] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6352,
		.family = MV88E6XXX_FAMILY_6352,
		.name = "Marvell 88E6352",
		.num_databases = 4096,
		.num_ports = 7,
4005
		.port_base_addr = 0x10,
4006
		.global1_addr = 0x1b,
4007
		.age_time_coeff = 15000,
4008
		.g1_irqs = 9,
4009
		.atu_move_port_mask = 0xf,
4010
		.pvt = true,
4011
		.tag_protocol = DSA_TAG_PROTO_EDSA,
4012
		.flags = MV88E6XXX_FLAGS_FAMILY_6352,
4013
		.ops = &mv88e6352_ops,
4014
	},
4015 4016 4017 4018 4019 4020 4021 4022
	[MV88E6390] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6390,
		.family = MV88E6XXX_FAMILY_6390,
		.name = "Marvell 88E6390",
		.num_databases = 4096,
		.num_ports = 11,	/* 10 + Z80 */
		.port_base_addr = 0x0,
		.global1_addr = 0x1b,
4023
		.age_time_coeff = 3750,
4024
		.g1_irqs = 9,
4025
		.atu_move_port_mask = 0x1f,
4026
		.pvt = true,
4027
		.tag_protocol = DSA_TAG_PROTO_DSA,
4028 4029 4030 4031 4032 4033 4034 4035 4036 4037 4038
		.flags = MV88E6XXX_FLAGS_FAMILY_6390,
		.ops = &mv88e6390_ops,
	},
	[MV88E6390X] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6390X,
		.family = MV88E6XXX_FAMILY_6390,
		.name = "Marvell 88E6390X",
		.num_databases = 4096,
		.num_ports = 11,	/* 10 + Z80 */
		.port_base_addr = 0x0,
		.global1_addr = 0x1b,
4039
		.age_time_coeff = 3750,
4040
		.g1_irqs = 9,
4041
		.atu_move_port_mask = 0x1f,
4042
		.pvt = true,
4043
		.tag_protocol = DSA_TAG_PROTO_DSA,
4044 4045 4046
		.flags = MV88E6XXX_FLAGS_FAMILY_6390,
		.ops = &mv88e6390x_ops,
	},
4047 4048
};

4049
static const struct mv88e6xxx_info *mv88e6xxx_lookup_info(unsigned int prod_num)
4050
{
4051
	int i;
4052

4053 4054 4055
	for (i = 0; i < ARRAY_SIZE(mv88e6xxx_table); ++i)
		if (mv88e6xxx_table[i].prod_num == prod_num)
			return &mv88e6xxx_table[i];
4056 4057 4058 4059

	return NULL;
}

4060
static int mv88e6xxx_detect(struct mv88e6xxx_chip *chip)
4061 4062
{
	const struct mv88e6xxx_info *info;
4063 4064 4065
	unsigned int prod_num, rev;
	u16 id;
	int err;
4066

4067 4068 4069 4070 4071
	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_port_read(chip, 0, PORT_SWITCH_ID, &id);
	mutex_unlock(&chip->reg_lock);
	if (err)
		return err;
4072 4073 4074 4075 4076 4077 4078 4079

	prod_num = (id & 0xfff0) >> 4;
	rev = id & 0x000f;

	info = mv88e6xxx_lookup_info(prod_num);
	if (!info)
		return -ENODEV;

4080
	/* Update the compatible info with the probed one */
4081
	chip->info = info;
4082

4083 4084 4085 4086
	err = mv88e6xxx_g2_require(chip);
	if (err)
		return err;

4087 4088
	dev_info(chip->dev, "switch 0x%x detected: %s, revision %u\n",
		 chip->info->prod_num, chip->info->name, rev);
4089 4090 4091 4092

	return 0;
}

4093
static struct mv88e6xxx_chip *mv88e6xxx_alloc_chip(struct device *dev)
4094
{
4095
	struct mv88e6xxx_chip *chip;
4096

4097 4098
	chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL);
	if (!chip)
4099 4100
		return NULL;

4101
	chip->dev = dev;
4102

4103
	mutex_init(&chip->reg_lock);
4104
	INIT_LIST_HEAD(&chip->mdios);
4105

4106
	return chip;
4107 4108
}

4109 4110
static void mv88e6xxx_phy_init(struct mv88e6xxx_chip *chip)
{
4111
	if (chip->info->ops->ppu_enable && chip->info->ops->ppu_disable)
4112 4113 4114
		mv88e6xxx_ppu_state_init(chip);
}

4115 4116
static void mv88e6xxx_phy_destroy(struct mv88e6xxx_chip *chip)
{
4117
	if (chip->info->ops->ppu_enable && chip->info->ops->ppu_disable)
4118 4119 4120
		mv88e6xxx_ppu_state_destroy(chip);
}

4121
static int mv88e6xxx_smi_init(struct mv88e6xxx_chip *chip,
4122 4123
			      struct mii_bus *bus, int sw_addr)
{
4124
	if (sw_addr == 0)
4125
		chip->smi_ops = &mv88e6xxx_smi_single_chip_ops;
4126
	else if (mv88e6xxx_has(chip, MV88E6XXX_FLAGS_MULTI_CHIP))
4127
		chip->smi_ops = &mv88e6xxx_smi_multi_chip_ops;
4128 4129 4130
	else
		return -EINVAL;

4131 4132
	chip->bus = bus;
	chip->sw_addr = sw_addr;
4133 4134 4135 4136

	return 0;
}

4137 4138
static enum dsa_tag_protocol mv88e6xxx_get_tag_protocol(struct dsa_switch *ds)
{
V
Vivien Didelot 已提交
4139
	struct mv88e6xxx_chip *chip = ds->priv;
4140

4141
	return chip->info->tag_protocol;
4142 4143
}

4144 4145 4146
static const char *mv88e6xxx_drv_probe(struct device *dsa_dev,
				       struct device *host_dev, int sw_addr,
				       void **priv)
4147
{
4148
	struct mv88e6xxx_chip *chip;
4149
	struct mii_bus *bus;
4150
	int err;
4151

4152
	bus = dsa_host_dev_to_mii_bus(host_dev);
4153 4154 4155
	if (!bus)
		return NULL;

4156 4157
	chip = mv88e6xxx_alloc_chip(dsa_dev);
	if (!chip)
4158 4159
		return NULL;

4160
	/* Legacy SMI probing will only support chips similar to 88E6085 */
4161
	chip->info = &mv88e6xxx_table[MV88E6085];
4162

4163
	err = mv88e6xxx_smi_init(chip, bus, sw_addr);
4164 4165 4166
	if (err)
		goto free;

4167
	err = mv88e6xxx_detect(chip);
4168
	if (err)
4169
		goto free;
4170

4171 4172 4173 4174 4175 4176
	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_switch_reset(chip);
	mutex_unlock(&chip->reg_lock);
	if (err)
		goto free;

4177 4178
	mv88e6xxx_phy_init(chip);

4179
	err = mv88e6xxx_mdios_register(chip, NULL);
4180
	if (err)
4181
		goto free;
4182

4183
	*priv = chip;
4184

4185
	return chip->info->name;
4186
free:
4187
	devm_kfree(dsa_dev, chip);
4188 4189

	return NULL;
4190 4191
}

4192 4193 4194 4195 4196 4197 4198 4199 4200 4201 4202 4203 4204 4205 4206
static int mv88e6xxx_port_mdb_prepare(struct dsa_switch *ds, int port,
				      const struct switchdev_obj_port_mdb *mdb,
				      struct switchdev_trans *trans)
{
	/* We don't need any dynamic resource from the kernel (yet),
	 * so skip the prepare phase.
	 */

	return 0;
}

static void mv88e6xxx_port_mdb_add(struct dsa_switch *ds, int port,
				   const struct switchdev_obj_port_mdb *mdb,
				   struct switchdev_trans *trans)
{
V
Vivien Didelot 已提交
4207
	struct mv88e6xxx_chip *chip = ds->priv;
4208 4209 4210 4211 4212 4213 4214 4215 4216 4217 4218

	mutex_lock(&chip->reg_lock);
	if (mv88e6xxx_port_db_load_purge(chip, port, mdb->addr, mdb->vid,
					 GLOBAL_ATU_DATA_STATE_MC_STATIC))
		netdev_err(ds->ports[port].netdev, "failed to load multicast MAC address\n");
	mutex_unlock(&chip->reg_lock);
}

static int mv88e6xxx_port_mdb_del(struct dsa_switch *ds, int port,
				  const struct switchdev_obj_port_mdb *mdb)
{
V
Vivien Didelot 已提交
4219
	struct mv88e6xxx_chip *chip = ds->priv;
4220 4221 4222 4223 4224 4225 4226 4227 4228 4229 4230 4231 4232 4233
	int err;

	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_port_db_load_purge(chip, port, mdb->addr, mdb->vid,
					   GLOBAL_ATU_DATA_STATE_UNUSED);
	mutex_unlock(&chip->reg_lock);

	return err;
}

static int mv88e6xxx_port_mdb_dump(struct dsa_switch *ds, int port,
				   struct switchdev_obj_port_mdb *mdb,
				   int (*cb)(struct switchdev_obj *obj))
{
V
Vivien Didelot 已提交
4234
	struct mv88e6xxx_chip *chip = ds->priv;
4235 4236 4237 4238 4239 4240 4241 4242 4243
	int err;

	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_port_db_dump(chip, port, &mdb->obj, cb);
	mutex_unlock(&chip->reg_lock);

	return err;
}

4244
static const struct dsa_switch_ops mv88e6xxx_switch_ops = {
4245
	.probe			= mv88e6xxx_drv_probe,
4246
	.get_tag_protocol	= mv88e6xxx_get_tag_protocol,
4247 4248 4249 4250 4251 4252 4253 4254
	.setup			= mv88e6xxx_setup,
	.set_addr		= mv88e6xxx_set_addr,
	.adjust_link		= mv88e6xxx_adjust_link,
	.get_strings		= mv88e6xxx_get_strings,
	.get_ethtool_stats	= mv88e6xxx_get_ethtool_stats,
	.get_sset_count		= mv88e6xxx_get_sset_count,
	.set_eee		= mv88e6xxx_set_eee,
	.get_eee		= mv88e6xxx_get_eee,
4255
	.get_eeprom_len		= mv88e6xxx_get_eeprom_len,
4256 4257 4258 4259
	.get_eeprom		= mv88e6xxx_get_eeprom,
	.set_eeprom		= mv88e6xxx_set_eeprom,
	.get_regs_len		= mv88e6xxx_get_regs_len,
	.get_regs		= mv88e6xxx_get_regs,
4260
	.set_ageing_time	= mv88e6xxx_set_ageing_time,
4261 4262 4263
	.port_bridge_join	= mv88e6xxx_port_bridge_join,
	.port_bridge_leave	= mv88e6xxx_port_bridge_leave,
	.port_stp_state_set	= mv88e6xxx_port_stp_state_set,
4264
	.port_fast_age		= mv88e6xxx_port_fast_age,
4265 4266 4267 4268 4269 4270 4271 4272 4273
	.port_vlan_filtering	= mv88e6xxx_port_vlan_filtering,
	.port_vlan_prepare	= mv88e6xxx_port_vlan_prepare,
	.port_vlan_add		= mv88e6xxx_port_vlan_add,
	.port_vlan_del		= mv88e6xxx_port_vlan_del,
	.port_vlan_dump		= mv88e6xxx_port_vlan_dump,
	.port_fdb_prepare       = mv88e6xxx_port_fdb_prepare,
	.port_fdb_add           = mv88e6xxx_port_fdb_add,
	.port_fdb_del           = mv88e6xxx_port_fdb_del,
	.port_fdb_dump          = mv88e6xxx_port_fdb_dump,
4274 4275 4276 4277
	.port_mdb_prepare       = mv88e6xxx_port_mdb_prepare,
	.port_mdb_add           = mv88e6xxx_port_mdb_add,
	.port_mdb_del           = mv88e6xxx_port_mdb_del,
	.port_mdb_dump          = mv88e6xxx_port_mdb_dump,
4278 4279
};

4280 4281 4282 4283
static struct dsa_switch_driver mv88e6xxx_switch_drv = {
	.ops			= &mv88e6xxx_switch_ops,
};

4284
static int mv88e6xxx_register_switch(struct mv88e6xxx_chip *chip)
4285
{
4286
	struct device *dev = chip->dev;
4287 4288
	struct dsa_switch *ds;

4289
	ds = dsa_switch_alloc(dev, DSA_MAX_PORTS);
4290 4291 4292
	if (!ds)
		return -ENOMEM;

4293
	ds->priv = chip;
4294
	ds->ops = &mv88e6xxx_switch_ops;
4295 4296
	ds->ageing_time_min = chip->info->age_time_coeff;
	ds->ageing_time_max = chip->info->age_time_coeff * U8_MAX;
4297 4298 4299

	dev_set_drvdata(dev, ds);

4300
	return dsa_register_switch(ds, dev);
4301 4302
}

4303
static void mv88e6xxx_unregister_switch(struct mv88e6xxx_chip *chip)
4304
{
4305
	dsa_unregister_switch(chip->ds);
4306 4307
}

4308
static int mv88e6xxx_probe(struct mdio_device *mdiodev)
4309
{
4310
	struct device *dev = &mdiodev->dev;
4311
	struct device_node *np = dev->of_node;
4312
	const struct mv88e6xxx_info *compat_info;
4313
	struct mv88e6xxx_chip *chip;
4314
	u32 eeprom_len;
4315
	int err;
4316

4317 4318 4319 4320
	compat_info = of_device_get_match_data(dev);
	if (!compat_info)
		return -EINVAL;

4321 4322
	chip = mv88e6xxx_alloc_chip(dev);
	if (!chip)
4323 4324
		return -ENOMEM;

4325
	chip->info = compat_info;
4326

4327
	err = mv88e6xxx_smi_init(chip, mdiodev->bus, mdiodev->addr);
4328 4329
	if (err)
		return err;
4330

4331 4332 4333 4334
	chip->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_LOW);
	if (IS_ERR(chip->reset))
		return PTR_ERR(chip->reset);

4335
	err = mv88e6xxx_detect(chip);
4336 4337
	if (err)
		return err;
4338

4339 4340
	mv88e6xxx_phy_init(chip);

4341
	if (chip->info->ops->get_eeprom &&
4342
	    !of_property_read_u32(np, "eeprom-length", &eeprom_len))
4343
		chip->eeprom_len = eeprom_len;
4344

4345 4346 4347 4348 4349 4350 4351 4352 4353 4354 4355 4356 4357 4358 4359 4360 4361 4362 4363 4364 4365 4366 4367 4368 4369 4370 4371 4372 4373 4374 4375
	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_switch_reset(chip);
	mutex_unlock(&chip->reg_lock);
	if (err)
		goto out;

	chip->irq = of_irq_get(np, 0);
	if (chip->irq == -EPROBE_DEFER) {
		err = chip->irq;
		goto out;
	}

	if (chip->irq > 0) {
		/* Has to be performed before the MDIO bus is created,
		 * because the PHYs will link there interrupts to these
		 * interrupt controllers
		 */
		mutex_lock(&chip->reg_lock);
		err = mv88e6xxx_g1_irq_setup(chip);
		mutex_unlock(&chip->reg_lock);

		if (err)
			goto out;

		if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT)) {
			err = mv88e6xxx_g2_irq_setup(chip);
			if (err)
				goto out_g1_irq;
		}
	}

4376
	err = mv88e6xxx_mdios_register(chip, np);
4377
	if (err)
4378
		goto out_g2_irq;
4379

4380
	err = mv88e6xxx_register_switch(chip);
4381 4382
	if (err)
		goto out_mdio;
4383

4384
	return 0;
4385 4386

out_mdio:
4387
	mv88e6xxx_mdios_unregister(chip);
4388
out_g2_irq:
4389
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT) && chip->irq > 0)
4390 4391
		mv88e6xxx_g2_irq_free(chip);
out_g1_irq:
4392 4393
	if (chip->irq > 0) {
		mutex_lock(&chip->reg_lock);
4394
		mv88e6xxx_g1_irq_free(chip);
4395 4396
		mutex_unlock(&chip->reg_lock);
	}
4397 4398
out:
	return err;
4399
}
4400 4401 4402 4403

static void mv88e6xxx_remove(struct mdio_device *mdiodev)
{
	struct dsa_switch *ds = dev_get_drvdata(&mdiodev->dev);
V
Vivien Didelot 已提交
4404
	struct mv88e6xxx_chip *chip = ds->priv;
4405

4406
	mv88e6xxx_phy_destroy(chip);
4407
	mv88e6xxx_unregister_switch(chip);
4408
	mv88e6xxx_mdios_unregister(chip);
4409

4410 4411 4412 4413 4414
	if (chip->irq > 0) {
		if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT))
			mv88e6xxx_g2_irq_free(chip);
		mv88e6xxx_g1_irq_free(chip);
	}
4415 4416 4417
}

static const struct of_device_id mv88e6xxx_of_match[] = {
4418 4419 4420 4421
	{
		.compatible = "marvell,mv88e6085",
		.data = &mv88e6xxx_table[MV88E6085],
	},
4422 4423 4424 4425
	{
		.compatible = "marvell,mv88e6190",
		.data = &mv88e6xxx_table[MV88E6190],
	},
4426 4427 4428 4429 4430 4431 4432 4433 4434 4435 4436 4437 4438 4439 4440 4441
	{ /* sentinel */ },
};

MODULE_DEVICE_TABLE(of, mv88e6xxx_of_match);

static struct mdio_driver mv88e6xxx_driver = {
	.probe	= mv88e6xxx_probe,
	.remove = mv88e6xxx_remove,
	.mdiodrv.driver = {
		.name = "mv88e6085",
		.of_match_table = mv88e6xxx_of_match,
	},
};

static int __init mv88e6xxx_init(void)
{
4442
	register_switch_driver(&mv88e6xxx_switch_drv);
4443 4444
	return mdio_driver_register(&mv88e6xxx_driver);
}
4445 4446 4447 4448
module_init(mv88e6xxx_init);

static void __exit mv88e6xxx_cleanup(void)
{
4449
	mdio_driver_unregister(&mv88e6xxx_driver);
4450
	unregister_switch_driver(&mv88e6xxx_switch_drv);
4451 4452
}
module_exit(mv88e6xxx_cleanup);
4453 4454 4455 4456

MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
MODULE_DESCRIPTION("Driver for Marvell 88E6XXX ethernet switch chips");
MODULE_LICENSE("GPL");