chip.c 120.5 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>
 *
11 12 13 14 15 16
 * 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.
 */

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

37
#include "mv88e6xxx.h"
38
#include "global1.h"
39
#include "global2.h"
40
#include "port.h"
41

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

50 51 52 53 54 55 56 57 58 59
/* 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.
60
 */
61

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

68
	return chip->smi_ops->read(chip, addr, reg, val);
69 70
}

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

77
	return chip->smi_ops->write(chip, addr, reg, val);
78 79
}

80
static int mv88e6xxx_smi_single_chip_read(struct mv88e6xxx_chip *chip,
81 82 83 84
					  int addr, int reg, u16 *val)
{
	int ret;

85
	ret = mdiobus_read_nested(chip->bus, addr, reg);
86 87 88 89 90 91 92 93
	if (ret < 0)
		return ret;

	*val = ret & 0xffff;

	return 0;
}

94
static int mv88e6xxx_smi_single_chip_write(struct mv88e6xxx_chip *chip,
95 96 97 98
					   int addr, int reg, u16 val)
{
	int ret;

99
	ret = mdiobus_write_nested(chip->bus, addr, reg, val);
100 101 102 103 104 105
	if (ret < 0)
		return ret;

	return 0;
}

106
static const struct mv88e6xxx_bus_ops mv88e6xxx_smi_single_chip_ops = {
107 108 109 110
	.read = mv88e6xxx_smi_single_chip_read,
	.write = mv88e6xxx_smi_single_chip_write,
};

111
static int mv88e6xxx_smi_multi_chip_wait(struct mv88e6xxx_chip *chip)
112 113 114 115 116
{
	int ret;
	int i;

	for (i = 0; i < 16; i++) {
117
		ret = mdiobus_read_nested(chip->bus, chip->sw_addr, SMI_CMD);
118 119 120
		if (ret < 0)
			return ret;

121
		if ((ret & SMI_CMD_BUSY) == 0)
122 123 124 125 126 127
			return 0;
	}

	return -ETIMEDOUT;
}

128
static int mv88e6xxx_smi_multi_chip_read(struct mv88e6xxx_chip *chip,
129
					 int addr, int reg, u16 *val)
130 131 132
{
	int ret;

133
	/* Wait for the bus to become free. */
134
	ret = mv88e6xxx_smi_multi_chip_wait(chip);
135 136 137
	if (ret < 0)
		return ret;

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

144
	/* Wait for the read command to complete. */
145
	ret = mv88e6xxx_smi_multi_chip_wait(chip);
146 147 148
	if (ret < 0)
		return ret;

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

154
	*val = ret & 0xffff;
155

156
	return 0;
157 158
}

159
static int mv88e6xxx_smi_multi_chip_write(struct mv88e6xxx_chip *chip,
160
					  int addr, int reg, u16 val)
161 162 163
{
	int ret;

164
	/* Wait for the bus to become free. */
165
	ret = mv88e6xxx_smi_multi_chip_wait(chip);
166 167 168
	if (ret < 0)
		return ret;

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

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

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

	return 0;
}

188
static const struct mv88e6xxx_bus_ops mv88e6xxx_smi_multi_chip_ops = {
189 190 191 192
	.read = mv88e6xxx_smi_multi_chip_read,
	.write = mv88e6xxx_smi_multi_chip_write,
};

193
int mv88e6xxx_read(struct mv88e6xxx_chip *chip, int addr, int reg, u16 *val)
194 195 196
{
	int err;

197
	assert_reg_lock(chip);
198

199
	err = mv88e6xxx_smi_read(chip, addr, reg, val);
200 201 202
	if (err)
		return err;

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

	return 0;
}

209
int mv88e6xxx_write(struct mv88e6xxx_chip *chip, int addr, int reg, u16 val)
210
{
211 212
	int err;

213
	assert_reg_lock(chip);
214

215
	err = mv88e6xxx_smi_write(chip, addr, reg, val);
216 217 218
	if (err)
		return err;

219
	dev_dbg(chip->dev, "-> addr: 0x%.2x reg: 0x%.2x val: 0x%.4x\n",
220 221
		addr, reg, val);

222 223 224
	return 0;
}

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

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

239 240 241 242 243 244 245 246 247 248 249 250
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;
}

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

257 258
	bus = mv88e6xxx_default_mdio_bus(chip);
	if (!bus)
259 260
		return -EOPNOTSUPP;

261
	if (!chip->info->ops->phy_read)
262 263 264
		return -EOPNOTSUPP;

	return chip->info->ops->phy_read(chip, bus, addr, reg, val);
265 266 267 268 269 270
}

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

273 274
	bus = mv88e6xxx_default_mdio_bus(chip);
	if (!bus)
275 276
		return -EOPNOTSUPP;

277
	if (!chip->info->ops->phy_write)
278 279 280
		return -EOPNOTSUPP;

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

283 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
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);
}

351 352 353 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
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;
452 453 454 455 456 457 458
	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);
459

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

465
	irq_domain_remove(chip->g1_irq.domain);
466 467 468 469
}

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

	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;

486
	err = mv88e6xxx_g1_read(chip, GLOBAL_CONTROL, &mask);
487
	if (err)
488
		goto out_mapping;
489

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

492
	err = mv88e6xxx_g1_write(chip, GLOBAL_CONTROL, mask);
493
	if (err)
494
		goto out_disable;
495 496 497 498

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

	err = request_threaded_irq(chip->irq, NULL,
				   mv88e6xxx_g1_irq_thread_fn,
				   IRQF_ONESHOT | IRQF_TRIGGER_FALLING,
				   dev_name(chip->dev), chip);
	if (err)
506
		goto out_disable;
507 508 509

	return 0;

510 511 512 513 514 515 516 517 518 519 520
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);
521 522 523 524

	return err;
}

525
int mv88e6xxx_wait(struct mv88e6xxx_chip *chip, int addr, int reg, u16 mask)
526
{
527
	int i;
528

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

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

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

		usleep_range(1000, 2000);
	}

543
	dev_err(chip->dev, "Timeout while waiting for switch\n");
544 545 546
	return -ETIMEDOUT;
}

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

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

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

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

564
static int mv88e6xxx_ppu_disable(struct mv88e6xxx_chip *chip)
565
{
566 567
	if (!chip->info->ops->ppu_disable)
		return 0;
568

569
	return chip->info->ops->ppu_disable(chip);
570 571
}

572
static int mv88e6xxx_ppu_enable(struct mv88e6xxx_chip *chip)
573
{
574 575
	if (!chip->info->ops->ppu_enable)
		return 0;
576

577
	return chip->info->ops->ppu_enable(chip);
578 579 580 581
}

static void mv88e6xxx_ppu_reenable_work(struct work_struct *ugly)
{
582
	struct mv88e6xxx_chip *chip;
583

584
	chip = container_of(ugly, struct mv88e6xxx_chip, ppu_work);
585

586
	mutex_lock(&chip->reg_lock);
587

588 589 590 591
	if (mutex_trylock(&chip->ppu_mutex)) {
		if (mv88e6xxx_ppu_enable(chip) == 0)
			chip->ppu_disabled = 0;
		mutex_unlock(&chip->ppu_mutex);
592
	}
593

594
	mutex_unlock(&chip->reg_lock);
595 596 597 598
}

static void mv88e6xxx_ppu_reenable_timer(unsigned long _ps)
{
599
	struct mv88e6xxx_chip *chip = (void *)_ps;
600

601
	schedule_work(&chip->ppu_work);
602 603
}

604
static int mv88e6xxx_ppu_access_get(struct mv88e6xxx_chip *chip)
605 606 607
{
	int ret;

608
	mutex_lock(&chip->ppu_mutex);
609

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

	return ret;
}

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

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

645 646 647 648 649
static void mv88e6xxx_ppu_state_destroy(struct mv88e6xxx_chip *chip)
{
	del_timer_sync(&chip->ppu_timer);
}

650 651 652
static int mv88e6xxx_phy_ppu_read(struct mv88e6xxx_chip *chip,
				  struct mii_bus *bus,
				  int addr, int reg, u16 *val)
653
{
654
	int err;
655

656 657 658
	err = mv88e6xxx_ppu_access_get(chip);
	if (!err) {
		err = mv88e6xxx_read(chip, addr, reg, val);
659
		mv88e6xxx_ppu_access_put(chip);
660 661
	}

662
	return err;
663 664
}

665 666 667
static int mv88e6xxx_phy_ppu_write(struct mv88e6xxx_chip *chip,
				   struct mii_bus *bus,
				   int addr, int reg, u16 val)
668
{
669
	int err;
670

671 672 673
	err = mv88e6xxx_ppu_access_get(chip);
	if (!err) {
		err = mv88e6xxx_write(chip, addr, reg, val);
674
		mv88e6xxx_ppu_access_put(chip);
675 676
	}

677
	return err;
678 679
}

680
static bool mv88e6xxx_6097_family(struct mv88e6xxx_chip *chip)
681
{
682
	return chip->info->family == MV88E6XXX_FAMILY_6097;
683 684
}

685
static bool mv88e6xxx_6165_family(struct mv88e6xxx_chip *chip)
686
{
687
	return chip->info->family == MV88E6XXX_FAMILY_6165;
688 689
}

690
static bool mv88e6xxx_6320_family(struct mv88e6xxx_chip *chip)
691
{
692
	return chip->info->family == MV88E6XXX_FAMILY_6320;
693 694
}

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

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

705
static bool mv88e6xxx_6352_family(struct mv88e6xxx_chip *chip)
706
{
707
	return chip->info->family == MV88E6XXX_FAMILY_6352;
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 740 741
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;
	}

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

748 749 750 751 752 753 754 755 756
	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;
}

757 758 759 760
/* 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.
 */
761 762
static void mv88e6xxx_adjust_link(struct dsa_switch *ds, int port,
				  struct phy_device *phydev)
763
{
V
Vivien Didelot 已提交
764
	struct mv88e6xxx_chip *chip = ds->priv;
765
	int err;
766 767 768 769

	if (!phy_is_pseudo_fixed_link(phydev))
		return;

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

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

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

784
	return chip->info->ops->stats_snapshot(chip, port);
785 786
}

787
static struct mv88e6xxx_hw_stat mv88e6xxx_hw_stats[] = {
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 845 846
	{ "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, },
847 848
};

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

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

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

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

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

903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918
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)
919
{
V
Vivien Didelot 已提交
920
	struct mv88e6xxx_chip *chip = ds->priv;
921 922 923 924 925 926 927 928

	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)
{
929 930 931 932 933
	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];
934
		if (stat->type & types)
935 936 937
			j++;
	}
	return j;
938 939
}

940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961
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;
}

962
static void mv88e6xxx_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
963 964
				      uint64_t *data, int types,
				      u16 bank1_select, u16 histogram)
965 966 967 968 969 970 971
{
	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) {
972 973 974
			data[j] = _mv88e6xxx_get_ethtool_stat(chip, stat, port,
							      bank1_select,
							      histogram);
975 976 977 978 979 980 981 982 983
			j++;
		}
	}
}

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

static void mv88e6320_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
				      uint64_t *data)
{
	return mv88e6xxx_stats_get_stats(chip, port, data,
992 993 994 995 996 997 998 999 1000 1001 1002
					 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);
1003 1004 1005 1006 1007 1008 1009 1010 1011
}

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);
}

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

1018
	mutex_lock(&chip->reg_lock);
1019

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

	mv88e6xxx_get_stats(chip, port, data);
1027

1028
	mutex_unlock(&chip->reg_lock);
1029 1030
}

1031 1032 1033 1034 1035 1036 1037 1038
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;
}

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

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

	regs->version = 0;

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

1057
	mutex_lock(&chip->reg_lock);
1058

1059 1060
	for (i = 0; i < 32; i++) {

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

1066
	mutex_unlock(&chip->reg_lock);
1067 1068
}

1069
static int _mv88e6xxx_atu_wait(struct mv88e6xxx_chip *chip)
1070
{
1071
	return mv88e6xxx_g1_wait(chip, GLOBAL_ATU_OP, GLOBAL_ATU_OP_BUSY);
1072 1073
}

1074 1075
static int mv88e6xxx_get_eee(struct dsa_switch *ds, int port,
			     struct ethtool_eee *e)
1076
{
V
Vivien Didelot 已提交
1077
	struct mv88e6xxx_chip *chip = ds->priv;
1078 1079
	u16 reg;
	int err;
1080

1081
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_EEE))
1082 1083
		return -EOPNOTSUPP;

1084
	mutex_lock(&chip->reg_lock);
1085

1086 1087
	err = mv88e6xxx_phy_read(chip, port, 16, &reg);
	if (err)
1088
		goto out;
1089 1090 1091 1092

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

1093
	err = mv88e6xxx_port_read(chip, port, PORT_STATUS, &reg);
1094
	if (err)
1095
		goto out;
1096

1097
	e->eee_active = !!(reg & PORT_STATUS_EEE);
1098
out:
1099
	mutex_unlock(&chip->reg_lock);
1100 1101

	return err;
1102 1103
}

1104 1105
static int mv88e6xxx_set_eee(struct dsa_switch *ds, int port,
			     struct phy_device *phydev, struct ethtool_eee *e)
1106
{
V
Vivien Didelot 已提交
1107
	struct mv88e6xxx_chip *chip = ds->priv;
1108 1109
	u16 reg;
	int err;
1110

1111
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_EEE))
1112 1113
		return -EOPNOTSUPP;

1114
	mutex_lock(&chip->reg_lock);
1115

1116 1117
	err = mv88e6xxx_phy_read(chip, port, 16, &reg);
	if (err)
1118 1119
		goto out;

1120
	reg &= ~0x0300;
1121 1122 1123 1124 1125
	if (e->eee_enabled)
		reg |= 0x0200;
	if (e->tx_lpi_enabled)
		reg |= 0x0100;

1126
	err = mv88e6xxx_phy_write(chip, port, 16, reg);
1127
out:
1128
	mutex_unlock(&chip->reg_lock);
1129

1130
	return err;
1131 1132
}

1133
static int _mv88e6xxx_atu_cmd(struct mv88e6xxx_chip *chip, u16 fid, u16 cmd)
1134
{
1135 1136
	u16 val;
	int err;
1137

1138
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G1_ATU_FID)) {
1139 1140 1141
		err = mv88e6xxx_g1_write(chip, GLOBAL_ATU_FID, fid);
		if (err)
			return err;
1142
	} else if (mv88e6xxx_num_databases(chip) == 256) {
1143
		/* ATU DBNum[7:4] are located in ATU Control 15:12 */
1144 1145 1146
		err = mv88e6xxx_g1_read(chip, GLOBAL_ATU_CONTROL, &val);
		if (err)
			return err;
1147

1148 1149 1150 1151
		err = mv88e6xxx_g1_write(chip, GLOBAL_ATU_CONTROL,
					 (val & 0xfff) | ((fid << 8) & 0xf000));
		if (err)
			return err;
1152 1153 1154

		/* ATU DBNum[3:0] are located in ATU Operation 3:0 */
		cmd |= fid & 0xf;
1155 1156
	}

1157 1158 1159
	err = mv88e6xxx_g1_write(chip, GLOBAL_ATU_OP, cmd);
	if (err)
		return err;
1160

1161
	return _mv88e6xxx_atu_wait(chip);
1162 1163
}

1164
static int _mv88e6xxx_atu_data_write(struct mv88e6xxx_chip *chip,
1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183
				     struct mv88e6xxx_atu_entry *entry)
{
	u16 data = entry->state & GLOBAL_ATU_DATA_STATE_MASK;

	if (entry->state != GLOBAL_ATU_DATA_STATE_UNUSED) {
		unsigned int mask, shift;

		if (entry->trunk) {
			data |= GLOBAL_ATU_DATA_TRUNK;
			mask = GLOBAL_ATU_DATA_TRUNK_ID_MASK;
			shift = GLOBAL_ATU_DATA_TRUNK_ID_SHIFT;
		} else {
			mask = GLOBAL_ATU_DATA_PORT_VECTOR_MASK;
			shift = GLOBAL_ATU_DATA_PORT_VECTOR_SHIFT;
		}

		data |= (entry->portv_trunkid << shift) & mask;
	}

1184
	return mv88e6xxx_g1_write(chip, GLOBAL_ATU_DATA, data);
1185 1186
}

1187
static int _mv88e6xxx_atu_flush_move(struct mv88e6xxx_chip *chip,
1188 1189
				     struct mv88e6xxx_atu_entry *entry,
				     bool static_too)
1190
{
1191 1192
	int op;
	int err;
1193

1194
	err = _mv88e6xxx_atu_wait(chip);
1195 1196
	if (err)
		return err;
1197

1198
	err = _mv88e6xxx_atu_data_write(chip, entry);
1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209
	if (err)
		return err;

	if (entry->fid) {
		op = static_too ? GLOBAL_ATU_OP_FLUSH_MOVE_ALL_DB :
			GLOBAL_ATU_OP_FLUSH_MOVE_NON_STATIC_DB;
	} else {
		op = static_too ? GLOBAL_ATU_OP_FLUSH_MOVE_ALL :
			GLOBAL_ATU_OP_FLUSH_MOVE_NON_STATIC;
	}

1210
	return _mv88e6xxx_atu_cmd(chip, entry->fid, op);
1211 1212
}

1213
static int _mv88e6xxx_atu_flush(struct mv88e6xxx_chip *chip,
1214
				u16 fid, bool static_too)
1215 1216 1217 1218 1219
{
	struct mv88e6xxx_atu_entry entry = {
		.fid = fid,
		.state = 0, /* EntryState bits must be 0 */
	};
1220

1221
	return _mv88e6xxx_atu_flush_move(chip, &entry, static_too);
1222 1223
}

1224
static int _mv88e6xxx_atu_move(struct mv88e6xxx_chip *chip, u16 fid,
1225
			       int from_port, int to_port, bool static_too)
1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238
{
	struct mv88e6xxx_atu_entry entry = {
		.trunk = false,
		.fid = fid,
	};

	/* EntryState bits must be 0xF */
	entry.state = GLOBAL_ATU_DATA_STATE_MASK;

	/* ToPort and FromPort are respectively in PortVec bits 7:4 and 3:0 */
	entry.portv_trunkid = (to_port & 0x0f) << 4;
	entry.portv_trunkid |= from_port & 0x0f;

1239
	return _mv88e6xxx_atu_flush_move(chip, &entry, static_too);
1240 1241
}

1242
static int _mv88e6xxx_atu_remove(struct mv88e6xxx_chip *chip, u16 fid,
1243
				 int port, bool static_too)
1244 1245
{
	/* Destination port 0xF means remove the entries */
1246
	return _mv88e6xxx_atu_move(chip, fid, port, 0x0f, static_too);
1247 1248
}

1249
static int _mv88e6xxx_port_based_vlan_map(struct mv88e6xxx_chip *chip, int port)
1250
{
1251
	struct dsa_switch *ds = chip->ds;
1252
	struct net_device *bridge = ds->ports[port].bridge_dev;
1253 1254 1255 1256 1257
	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)) {
1258
		output_ports = ~0;
1259
	} else {
1260
		for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1261
			/* allow sending frames to every group member */
1262
			if (bridge && ds->ports[i].bridge_dev == bridge)
1263 1264 1265 1266 1267 1268 1269 1270 1271 1272
				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);
1273

1274
	return mv88e6xxx_port_set_vlan_map(chip, port, output_ports);
1275 1276
}

1277 1278
static void mv88e6xxx_port_stp_state_set(struct dsa_switch *ds, int port,
					 u8 state)
1279
{
V
Vivien Didelot 已提交
1280
	struct mv88e6xxx_chip *chip = ds->priv;
1281
	int stp_state;
1282
	int err;
1283 1284 1285

	switch (state) {
	case BR_STATE_DISABLED:
1286
		stp_state = PORT_CONTROL_STATE_DISABLED;
1287 1288 1289
		break;
	case BR_STATE_BLOCKING:
	case BR_STATE_LISTENING:
1290
		stp_state = PORT_CONTROL_STATE_BLOCKING;
1291 1292
		break;
	case BR_STATE_LEARNING:
1293
		stp_state = PORT_CONTROL_STATE_LEARNING;
1294 1295 1296
		break;
	case BR_STATE_FORWARDING:
	default:
1297
		stp_state = PORT_CONTROL_STATE_FORWARDING;
1298 1299 1300
		break;
	}

1301
	mutex_lock(&chip->reg_lock);
1302
	err = mv88e6xxx_port_set_state(chip, port, stp_state);
1303
	mutex_unlock(&chip->reg_lock);
1304 1305

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

1309 1310
static int mv88e6xxx_atu_setup(struct mv88e6xxx_chip *chip)
{
1311 1312 1313 1314 1315 1316
	int err;

	err = mv88e6xxx_g1_atu_set_learn2all(chip, true);
	if (err)
		return err;

1317 1318 1319
	return mv88e6xxx_g1_atu_set_age_time(chip, 300000);
}

1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332
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);
	err = _mv88e6xxx_atu_remove(chip, 0, port, false);
	mutex_unlock(&chip->reg_lock);

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

1333
static int _mv88e6xxx_vtu_wait(struct mv88e6xxx_chip *chip)
1334
{
1335
	return mv88e6xxx_g1_wait(chip, GLOBAL_VTU_OP, GLOBAL_VTU_OP_BUSY);
1336 1337
}

1338
static int _mv88e6xxx_vtu_cmd(struct mv88e6xxx_chip *chip, u16 op)
1339
{
1340
	int err;
1341

1342 1343 1344
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_OP, op);
	if (err)
		return err;
1345

1346
	return _mv88e6xxx_vtu_wait(chip);
1347 1348
}

1349
static int _mv88e6xxx_vtu_stu_flush(struct mv88e6xxx_chip *chip)
1350 1351 1352
{
	int ret;

1353
	ret = _mv88e6xxx_vtu_wait(chip);
1354 1355 1356
	if (ret < 0)
		return ret;

1357
	return _mv88e6xxx_vtu_cmd(chip, GLOBAL_VTU_OP_FLUSH_ALL);
1358 1359
}

1360
static int _mv88e6xxx_vtu_stu_data_read(struct mv88e6xxx_chip *chip,
1361
					struct mv88e6xxx_vtu_entry *entry,
1362 1363 1364
					unsigned int nibble_offset)
{
	u16 regs[3];
1365
	int i, err;
1366 1367

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

1370 1371 1372
		err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_DATA_0_3 + i, reg);
		if (err)
			return err;
1373 1374
	}

1375
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1376 1377 1378 1379 1380 1381 1382 1383 1384
		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;
}

1385
static int mv88e6xxx_vtu_data_read(struct mv88e6xxx_chip *chip,
1386
				   struct mv88e6xxx_vtu_entry *entry)
1387
{
1388
	return _mv88e6xxx_vtu_stu_data_read(chip, entry, 0);
1389 1390
}

1391
static int mv88e6xxx_stu_data_read(struct mv88e6xxx_chip *chip,
1392
				   struct mv88e6xxx_vtu_entry *entry)
1393
{
1394
	return _mv88e6xxx_vtu_stu_data_read(chip, entry, 2);
1395 1396
}

1397
static int _mv88e6xxx_vtu_stu_data_write(struct mv88e6xxx_chip *chip,
1398
					 struct mv88e6xxx_vtu_entry *entry,
1399 1400 1401
					 unsigned int nibble_offset)
{
	u16 regs[3] = { 0 };
1402
	int i, err;
1403

1404
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1405 1406 1407 1408 1409 1410 1411
		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) {
1412 1413 1414 1415 1416
		u16 reg = regs[i];

		err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_DATA_0_3 + i, reg);
		if (err)
			return err;
1417 1418 1419 1420 1421
	}

	return 0;
}

1422
static int mv88e6xxx_vtu_data_write(struct mv88e6xxx_chip *chip,
1423
				    struct mv88e6xxx_vtu_entry *entry)
1424
{
1425
	return _mv88e6xxx_vtu_stu_data_write(chip, entry, 0);
1426 1427
}

1428
static int mv88e6xxx_stu_data_write(struct mv88e6xxx_chip *chip,
1429
				    struct mv88e6xxx_vtu_entry *entry)
1430
{
1431
	return _mv88e6xxx_vtu_stu_data_write(chip, entry, 2);
1432 1433
}

1434
static int _mv88e6xxx_vtu_vid_write(struct mv88e6xxx_chip *chip, u16 vid)
1435
{
1436 1437
	return mv88e6xxx_g1_write(chip, GLOBAL_VTU_VID,
				  vid & GLOBAL_VTU_VID_MASK);
1438 1439
}

1440
static int _mv88e6xxx_vtu_getnext(struct mv88e6xxx_chip *chip,
1441
				  struct mv88e6xxx_vtu_entry *entry)
1442
{
1443
	struct mv88e6xxx_vtu_entry next = { 0 };
1444 1445
	u16 val;
	int err;
1446

1447 1448 1449
	err = _mv88e6xxx_vtu_wait(chip);
	if (err)
		return err;
1450

1451 1452 1453
	err = _mv88e6xxx_vtu_cmd(chip, GLOBAL_VTU_OP_VTU_GET_NEXT);
	if (err)
		return err;
1454

1455 1456 1457
	err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_VID, &val);
	if (err)
		return err;
1458

1459 1460
	next.vid = val & GLOBAL_VTU_VID_MASK;
	next.valid = !!(val & GLOBAL_VTU_VID_VALID);
1461 1462

	if (next.valid) {
1463 1464 1465
		err = mv88e6xxx_vtu_data_read(chip, &next);
		if (err)
			return err;
1466

1467
		if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G1_VTU_FID)) {
1468 1469 1470
			err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_FID, &val);
			if (err)
				return err;
1471

1472
			next.fid = val & GLOBAL_VTU_FID_MASK;
1473
		} else if (mv88e6xxx_num_databases(chip) == 256) {
1474 1475 1476
			/* VTU DBNum[7:4] are located in VTU Operation 11:8, and
			 * VTU DBNum[3:0] are located in VTU Operation 3:0
			 */
1477 1478 1479
			err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_OP, &val);
			if (err)
				return err;
1480

1481 1482
			next.fid = (val & 0xf00) >> 4;
			next.fid |= val & 0xf;
1483
		}
1484

1485
		if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_STU)) {
1486 1487 1488
			err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_SID, &val);
			if (err)
				return err;
1489

1490
			next.sid = val & GLOBAL_VTU_SID_MASK;
1491 1492 1493 1494 1495 1496 1497
		}
	}

	*entry = next;
	return 0;
}

1498 1499 1500
static int mv88e6xxx_port_vlan_dump(struct dsa_switch *ds, int port,
				    struct switchdev_obj_port_vlan *vlan,
				    int (*cb)(struct switchdev_obj *obj))
1501
{
V
Vivien Didelot 已提交
1502
	struct mv88e6xxx_chip *chip = ds->priv;
1503
	struct mv88e6xxx_vtu_entry next;
1504 1505 1506
	u16 pvid;
	int err;

1507
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1508 1509
		return -EOPNOTSUPP;

1510
	mutex_lock(&chip->reg_lock);
1511

1512
	err = mv88e6xxx_port_get_pvid(chip, port, &pvid);
1513 1514 1515
	if (err)
		goto unlock;

1516
	err = _mv88e6xxx_vtu_vid_write(chip, GLOBAL_VTU_VID_MASK);
1517 1518 1519 1520
	if (err)
		goto unlock;

	do {
1521
		err = _mv88e6xxx_vtu_getnext(chip, &next);
1522 1523 1524 1525 1526 1527 1528 1529 1530 1531
		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 */
1532 1533
		vlan->vid_begin = next.vid;
		vlan->vid_end = next.vid;
1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547
		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:
1548
	mutex_unlock(&chip->reg_lock);
1549 1550 1551 1552

	return err;
}

1553
static int _mv88e6xxx_vtu_loadpurge(struct mv88e6xxx_chip *chip,
1554
				    struct mv88e6xxx_vtu_entry *entry)
1555
{
1556
	u16 op = GLOBAL_VTU_OP_VTU_LOAD_PURGE;
1557
	u16 reg = 0;
1558
	int err;
1559

1560 1561 1562
	err = _mv88e6xxx_vtu_wait(chip);
	if (err)
		return err;
1563 1564 1565 1566 1567

	if (!entry->valid)
		goto loadpurge;

	/* Write port member tags */
1568 1569 1570
	err = mv88e6xxx_vtu_data_write(chip, entry);
	if (err)
		return err;
1571

1572
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_STU)) {
1573
		reg = entry->sid & GLOBAL_VTU_SID_MASK;
1574 1575 1576
		err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_SID, reg);
		if (err)
			return err;
1577
	}
1578

1579
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G1_VTU_FID)) {
1580
		reg = entry->fid & GLOBAL_VTU_FID_MASK;
1581 1582 1583
		err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_FID, reg);
		if (err)
			return err;
1584
	} else if (mv88e6xxx_num_databases(chip) == 256) {
1585 1586 1587 1588 1589
		/* 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;
1590 1591 1592 1593 1594
	}

	reg = GLOBAL_VTU_VID_VALID;
loadpurge:
	reg |= entry->vid & GLOBAL_VTU_VID_MASK;
1595 1596 1597
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_VID, reg);
	if (err)
		return err;
1598

1599
	return _mv88e6xxx_vtu_cmd(chip, op);
1600 1601
}

1602
static int _mv88e6xxx_stu_getnext(struct mv88e6xxx_chip *chip, u8 sid,
1603
				  struct mv88e6xxx_vtu_entry *entry)
1604
{
1605
	struct mv88e6xxx_vtu_entry next = { 0 };
1606 1607
	u16 val;
	int err;
1608

1609 1610 1611
	err = _mv88e6xxx_vtu_wait(chip);
	if (err)
		return err;
1612

1613 1614 1615 1616
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_SID,
				 sid & GLOBAL_VTU_SID_MASK);
	if (err)
		return err;
1617

1618 1619 1620
	err = _mv88e6xxx_vtu_cmd(chip, GLOBAL_VTU_OP_STU_GET_NEXT);
	if (err)
		return err;
1621

1622 1623 1624
	err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_SID, &val);
	if (err)
		return err;
1625

1626
	next.sid = val & GLOBAL_VTU_SID_MASK;
1627

1628 1629 1630
	err = mv88e6xxx_g1_read(chip, GLOBAL_VTU_VID, &val);
	if (err)
		return err;
1631

1632
	next.valid = !!(val & GLOBAL_VTU_VID_VALID);
1633 1634

	if (next.valid) {
1635 1636 1637
		err = mv88e6xxx_stu_data_read(chip, &next);
		if (err)
			return err;
1638 1639 1640 1641 1642 1643
	}

	*entry = next;
	return 0;
}

1644
static int _mv88e6xxx_stu_loadpurge(struct mv88e6xxx_chip *chip,
1645
				    struct mv88e6xxx_vtu_entry *entry)
1646 1647
{
	u16 reg = 0;
1648
	int err;
1649

1650 1651 1652
	err = _mv88e6xxx_vtu_wait(chip);
	if (err)
		return err;
1653 1654 1655 1656 1657

	if (!entry->valid)
		goto loadpurge;

	/* Write port states */
1658 1659 1660
	err = mv88e6xxx_stu_data_write(chip, entry);
	if (err)
		return err;
1661 1662 1663

	reg = GLOBAL_VTU_VID_VALID;
loadpurge:
1664 1665 1666
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_VID, reg);
	if (err)
		return err;
1667 1668

	reg = entry->sid & GLOBAL_VTU_SID_MASK;
1669 1670 1671
	err = mv88e6xxx_g1_write(chip, GLOBAL_VTU_SID, reg);
	if (err)
		return err;
1672

1673
	return _mv88e6xxx_vtu_cmd(chip, GLOBAL_VTU_OP_STU_LOAD_PURGE);
1674 1675
}

1676
static int _mv88e6xxx_fid_new(struct mv88e6xxx_chip *chip, u16 *fid)
1677 1678
{
	DECLARE_BITMAP(fid_bitmap, MV88E6XXX_N_FID);
1679
	struct mv88e6xxx_vtu_entry vlan;
1680
	int i, err;
1681 1682 1683

	bitmap_zero(fid_bitmap, MV88E6XXX_N_FID);

1684
	/* Set every FID bit used by the (un)bridged ports */
1685
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1686
		err = mv88e6xxx_port_get_fid(chip, i, fid);
1687 1688 1689 1690 1691 1692
		if (err)
			return err;

		set_bit(*fid, fid_bitmap);
	}

1693
	/* Set every FID bit used by the VLAN entries */
1694
	err = _mv88e6xxx_vtu_vid_write(chip, GLOBAL_VTU_VID_MASK);
1695 1696 1697 1698
	if (err)
		return err;

	do {
1699
		err = _mv88e6xxx_vtu_getnext(chip, &vlan);
1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712
		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);
1713
	if (unlikely(*fid >= mv88e6xxx_num_databases(chip)))
1714 1715 1716
		return -ENOSPC;

	/* Clear the database */
1717
	return _mv88e6xxx_atu_flush(chip, *fid, true);
1718 1719
}

1720
static int _mv88e6xxx_vtu_new(struct mv88e6xxx_chip *chip, u16 vid,
1721
			      struct mv88e6xxx_vtu_entry *entry)
1722
{
1723
	struct dsa_switch *ds = chip->ds;
1724
	struct mv88e6xxx_vtu_entry vlan = {
1725 1726 1727
		.valid = true,
		.vid = vid,
	};
1728 1729
	int i, err;

1730
	err = _mv88e6xxx_fid_new(chip, &vlan.fid);
1731 1732
	if (err)
		return err;
1733

1734
	/* exclude all ports except the CPU and DSA ports */
1735
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i)
1736 1737 1738
		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;
1739

1740
	if (mv88e6xxx_6097_family(chip) || mv88e6xxx_6165_family(chip) ||
1741 1742
	    mv88e6xxx_6351_family(chip) || mv88e6xxx_6352_family(chip) ||
	    mv88e6xxx_6341_family(chip)) {
1743
		struct mv88e6xxx_vtu_entry vstp;
1744 1745 1746 1747 1748 1749

		/* 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;
1750
		err = _mv88e6xxx_stu_getnext(chip, GLOBAL_VTU_SID_MASK, &vstp);
1751 1752 1753 1754 1755 1756 1757 1758
		if (err)
			return err;

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

1759
			err = _mv88e6xxx_stu_loadpurge(chip, &vstp);
1760 1761 1762 1763 1764 1765 1766 1767 1768
			if (err)
				return err;
		}
	}

	*entry = vlan;
	return 0;
}

1769
static int _mv88e6xxx_vtu_get(struct mv88e6xxx_chip *chip, u16 vid,
1770
			      struct mv88e6xxx_vtu_entry *entry, bool creat)
1771 1772 1773 1774 1775 1776
{
	int err;

	if (!vid)
		return -EINVAL;

1777
	err = _mv88e6xxx_vtu_vid_write(chip, vid - 1);
1778 1779 1780
	if (err)
		return err;

1781
	err = _mv88e6xxx_vtu_getnext(chip, entry);
1782 1783 1784 1785 1786 1787 1788 1789 1790 1791
	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.
		 */

1792
		err = _mv88e6xxx_vtu_new(chip, vid, entry);
1793 1794 1795 1796 1797
	}

	return err;
}

1798 1799 1800
static int mv88e6xxx_port_check_hw_vlan(struct dsa_switch *ds, int port,
					u16 vid_begin, u16 vid_end)
{
V
Vivien Didelot 已提交
1801
	struct mv88e6xxx_chip *chip = ds->priv;
1802
	struct mv88e6xxx_vtu_entry vlan;
1803 1804 1805 1806 1807
	int i, err;

	if (!vid_begin)
		return -EOPNOTSUPP;

1808
	mutex_lock(&chip->reg_lock);
1809

1810
	err = _mv88e6xxx_vtu_vid_write(chip, vid_begin - 1);
1811 1812 1813 1814
	if (err)
		goto unlock;

	do {
1815
		err = _mv88e6xxx_vtu_getnext(chip, &vlan);
1816 1817 1818 1819 1820 1821 1822 1823 1824
		if (err)
			goto unlock;

		if (!vlan.valid)
			break;

		if (vlan.vid > vid_end)
			break;

1825
		for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1826 1827 1828
			if (dsa_is_dsa_port(ds, i) || dsa_is_cpu_port(ds, i))
				continue;

1829 1830 1831
			if (!ds->ports[port].netdev)
				continue;

1832 1833 1834 1835
			if (vlan.data[i] ==
			    GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER)
				continue;

1836 1837
			if (ds->ports[i].bridge_dev ==
			    ds->ports[port].bridge_dev)
1838 1839
				break; /* same bridge, check next VLAN */

1840
			if (!ds->ports[i].bridge_dev)
1841 1842
				continue;

1843
			netdev_warn(ds->ports[port].netdev,
1844 1845
				    "hardware VLAN %d already used by %s\n",
				    vlan.vid,
1846
				    netdev_name(ds->ports[i].bridge_dev));
1847 1848 1849 1850 1851 1852
			err = -EOPNOTSUPP;
			goto unlock;
		}
	} while (vlan.vid < vid_end);

unlock:
1853
	mutex_unlock(&chip->reg_lock);
1854 1855 1856 1857

	return err;
}

1858 1859
static int mv88e6xxx_port_vlan_filtering(struct dsa_switch *ds, int port,
					 bool vlan_filtering)
1860
{
V
Vivien Didelot 已提交
1861
	struct mv88e6xxx_chip *chip = ds->priv;
1862
	u16 mode = vlan_filtering ? PORT_CONTROL_2_8021Q_SECURE :
1863
		PORT_CONTROL_2_8021Q_DISABLED;
1864
	int err;
1865

1866
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1867 1868
		return -EOPNOTSUPP;

1869
	mutex_lock(&chip->reg_lock);
1870
	err = mv88e6xxx_port_set_8021q_mode(chip, port, mode);
1871
	mutex_unlock(&chip->reg_lock);
1872

1873
	return err;
1874 1875
}

1876 1877 1878 1879
static int
mv88e6xxx_port_vlan_prepare(struct dsa_switch *ds, int port,
			    const struct switchdev_obj_port_vlan *vlan,
			    struct switchdev_trans *trans)
1880
{
V
Vivien Didelot 已提交
1881
	struct mv88e6xxx_chip *chip = ds->priv;
1882 1883
	int err;

1884
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1885 1886
		return -EOPNOTSUPP;

1887 1888 1889 1890 1891 1892 1893 1894
	/* 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;

1895 1896 1897 1898 1899 1900
	/* We don't need any dynamic resource from the kernel (yet),
	 * so skip the prepare phase.
	 */
	return 0;
}

1901
static int _mv88e6xxx_port_vlan_add(struct mv88e6xxx_chip *chip, int port,
1902
				    u16 vid, bool untagged)
1903
{
1904
	struct mv88e6xxx_vtu_entry vlan;
1905 1906
	int err;

1907
	err = _mv88e6xxx_vtu_get(chip, vid, &vlan, true);
1908
	if (err)
1909
		return err;
1910 1911 1912 1913 1914

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

1915
	return _mv88e6xxx_vtu_loadpurge(chip, &vlan);
1916 1917
}

1918 1919 1920
static void mv88e6xxx_port_vlan_add(struct dsa_switch *ds, int port,
				    const struct switchdev_obj_port_vlan *vlan,
				    struct switchdev_trans *trans)
1921
{
V
Vivien Didelot 已提交
1922
	struct mv88e6xxx_chip *chip = ds->priv;
1923 1924 1925 1926
	bool untagged = vlan->flags & BRIDGE_VLAN_INFO_UNTAGGED;
	bool pvid = vlan->flags & BRIDGE_VLAN_INFO_PVID;
	u16 vid;

1927
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1928 1929
		return;

1930
	mutex_lock(&chip->reg_lock);
1931

1932
	for (vid = vlan->vid_begin; vid <= vlan->vid_end; ++vid)
1933
		if (_mv88e6xxx_port_vlan_add(chip, port, vid, untagged))
1934 1935
			netdev_err(ds->ports[port].netdev,
				   "failed to add VLAN %d%c\n",
1936
				   vid, untagged ? 'u' : 't');
1937

1938
	if (pvid && mv88e6xxx_port_set_pvid(chip, port, vlan->vid_end))
1939
		netdev_err(ds->ports[port].netdev, "failed to set PVID %d\n",
1940
			   vlan->vid_end);
1941

1942
	mutex_unlock(&chip->reg_lock);
1943 1944
}

1945
static int _mv88e6xxx_port_vlan_del(struct mv88e6xxx_chip *chip,
1946
				    int port, u16 vid)
1947
{
1948
	struct dsa_switch *ds = chip->ds;
1949
	struct mv88e6xxx_vtu_entry vlan;
1950 1951
	int i, err;

1952
	err = _mv88e6xxx_vtu_get(chip, vid, &vlan, false);
1953
	if (err)
1954
		return err;
1955

1956 1957
	/* Tell switchdev if this VLAN is handled in software */
	if (vlan.data[port] == GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER)
1958
		return -EOPNOTSUPP;
1959 1960 1961 1962

	vlan.data[port] = GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER;

	/* keep the VLAN unless all ports are excluded */
1963
	vlan.valid = false;
1964
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
1965
		if (dsa_is_cpu_port(ds, i) || dsa_is_dsa_port(ds, i))
1966 1967 1968
			continue;

		if (vlan.data[i] != GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER) {
1969
			vlan.valid = true;
1970 1971 1972 1973
			break;
		}
	}

1974
	err = _mv88e6xxx_vtu_loadpurge(chip, &vlan);
1975 1976 1977
	if (err)
		return err;

1978
	return _mv88e6xxx_atu_remove(chip, vlan.fid, port, false);
1979 1980
}

1981 1982
static int mv88e6xxx_port_vlan_del(struct dsa_switch *ds, int port,
				   const struct switchdev_obj_port_vlan *vlan)
1983
{
V
Vivien Didelot 已提交
1984
	struct mv88e6xxx_chip *chip = ds->priv;
1985 1986 1987
	u16 pvid, vid;
	int err = 0;

1988
	if (!mv88e6xxx_has(chip, MV88E6XXX_FLAG_VTU))
1989 1990
		return -EOPNOTSUPP;

1991
	mutex_lock(&chip->reg_lock);
1992

1993
	err = mv88e6xxx_port_get_pvid(chip, port, &pvid);
1994 1995 1996
	if (err)
		goto unlock;

1997
	for (vid = vlan->vid_begin; vid <= vlan->vid_end; ++vid) {
1998
		err = _mv88e6xxx_port_vlan_del(chip, port, vid);
1999 2000 2001 2002
		if (err)
			goto unlock;

		if (vid == pvid) {
2003
			err = mv88e6xxx_port_set_pvid(chip, port, 0);
2004 2005 2006 2007 2008
			if (err)
				goto unlock;
		}
	}

2009
unlock:
2010
	mutex_unlock(&chip->reg_lock);
2011 2012 2013 2014

	return err;
}

2015 2016 2017
static int mv88e6xxx_port_db_load_purge(struct mv88e6xxx_chip *chip, int port,
					const unsigned char *addr, u16 vid,
					u8 state)
2018
{
2019
	struct mv88e6xxx_vtu_entry vlan;
2020
	struct mv88e6xxx_atu_entry entry;
2021 2022
	int err;

2023 2024
	/* Null VLAN ID corresponds to the port private database */
	if (vid == 0)
2025
		err = mv88e6xxx_port_get_fid(chip, port, &vlan.fid);
2026
	else
2027
		err = _mv88e6xxx_vtu_get(chip, vid, &vlan, false);
2028 2029
	if (err)
		return err;
2030

2031 2032 2033 2034 2035
	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);
2036 2037 2038
	if (err)
		return err;

2039 2040 2041 2042 2043 2044 2045
	/* 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);
	}

2046 2047 2048 2049 2050 2051 2052 2053
	/* Purge the ATU entry only if no port is using it anymore */
	if (state == GLOBAL_ATU_DATA_STATE_UNUSED) {
		entry.portv_trunkid &= ~BIT(port);
		if (!entry.portv_trunkid)
			entry.state = GLOBAL_ATU_DATA_STATE_UNUSED;
	} else {
		entry.portv_trunkid |= BIT(port);
		entry.state = state;
2054 2055
	}

2056
	return mv88e6xxx_g1_atu_loadpurge(chip, vlan.fid, &entry);
2057 2058
}

2059 2060 2061
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 已提交
2062 2063 2064 2065 2066 2067 2068
{
	/* We don't need any dynamic resource from the kernel (yet),
	 * so skip the prepare phase.
	 */
	return 0;
}

2069 2070 2071
static void mv88e6xxx_port_fdb_add(struct dsa_switch *ds, int port,
				   const struct switchdev_obj_port_fdb *fdb,
				   struct switchdev_trans *trans)
2072
{
V
Vivien Didelot 已提交
2073
	struct mv88e6xxx_chip *chip = ds->priv;
2074

2075
	mutex_lock(&chip->reg_lock);
2076 2077 2078
	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");
2079
	mutex_unlock(&chip->reg_lock);
2080 2081
}

2082 2083
static int mv88e6xxx_port_fdb_del(struct dsa_switch *ds, int port,
				  const struct switchdev_obj_port_fdb *fdb)
2084
{
V
Vivien Didelot 已提交
2085
	struct mv88e6xxx_chip *chip = ds->priv;
2086
	int err;
2087

2088
	mutex_lock(&chip->reg_lock);
2089 2090
	err = mv88e6xxx_port_db_load_purge(chip, port, fdb->addr, fdb->vid,
					   GLOBAL_ATU_DATA_STATE_UNUSED);
2091
	mutex_unlock(&chip->reg_lock);
2092

2093
	return err;
2094 2095
}

2096 2097 2098 2099
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))
2100
{
2101
	struct mv88e6xxx_atu_entry addr;
2102 2103
	int err;

2104 2105
	addr.state = GLOBAL_ATU_DATA_STATE_UNUSED;
	eth_broadcast_addr(addr.mac);
2106 2107

	do {
2108
		err = mv88e6xxx_g1_atu_getnext(chip, fid, &addr);
2109
		if (err)
2110
			return err;
2111 2112 2113 2114

		if (addr.state == GLOBAL_ATU_DATA_STATE_UNUSED)
			break;

2115 2116 2117 2118 2119
		if (addr.trunk || (addr.portv_trunkid & BIT(port)) == 0)
			continue;

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

2121 2122 2123 2124
			if (!is_unicast_ether_addr(addr.mac))
				continue;

			fdb = SWITCHDEV_OBJ_PORT_FDB(obj);
2125 2126
			fdb->vid = vid;
			ether_addr_copy(fdb->addr, addr.mac);
2127 2128 2129 2130
			if (addr.state == GLOBAL_ATU_DATA_STATE_UC_STATIC)
				fdb->ndm_state = NUD_NOARP;
			else
				fdb->ndm_state = NUD_REACHABLE;
2131 2132 2133 2134 2135 2136 2137 2138 2139
		} 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);
2140 2141
		} else {
			return -EOPNOTSUPP;
2142
		}
2143 2144 2145 2146

		err = cb(obj);
		if (err)
			return err;
2147 2148 2149 2150 2151
	} while (!is_broadcast_ether_addr(addr.mac));

	return err;
}

2152 2153 2154
static int mv88e6xxx_port_db_dump(struct mv88e6xxx_chip *chip, int port,
				  struct switchdev_obj *obj,
				  int (*cb)(struct switchdev_obj *obj))
2155
{
2156
	struct mv88e6xxx_vtu_entry vlan = {
2157 2158
		.vid = GLOBAL_VTU_VID_MASK, /* all ones */
	};
2159
	u16 fid;
2160 2161
	int err;

2162
	/* Dump port's default Filtering Information Database (VLAN ID 0) */
2163
	err = mv88e6xxx_port_get_fid(chip, port, &fid);
2164
	if (err)
2165
		return err;
2166

2167
	err = mv88e6xxx_port_db_dump_fid(chip, fid, 0, port, obj, cb);
2168
	if (err)
2169
		return err;
2170

2171
	/* Dump VLANs' Filtering Information Databases */
2172
	err = _mv88e6xxx_vtu_vid_write(chip, vlan.vid);
2173
	if (err)
2174
		return err;
2175 2176

	do {
2177
		err = _mv88e6xxx_vtu_getnext(chip, &vlan);
2178
		if (err)
2179
			return err;
2180 2181 2182 2183

		if (!vlan.valid)
			break;

2184 2185
		err = mv88e6xxx_port_db_dump_fid(chip, vlan.fid, vlan.vid, port,
						 obj, cb);
2186
		if (err)
2187
			return err;
2188 2189
	} while (vlan.vid < GLOBAL_VTU_VID_MASK);

2190 2191 2192 2193 2194 2195 2196
	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 已提交
2197
	struct mv88e6xxx_chip *chip = ds->priv;
2198 2199 2200 2201
	int err;

	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_port_db_dump(chip, port, &fdb->obj, cb);
2202
	mutex_unlock(&chip->reg_lock);
2203 2204 2205 2206

	return err;
}

2207
static int mv88e6xxx_port_bridge_join(struct dsa_switch *ds, int port,
2208
				      struct net_device *br)
2209
{
V
Vivien Didelot 已提交
2210
	struct mv88e6xxx_chip *chip = ds->priv;
2211
	int i, err = 0;
2212

2213
	mutex_lock(&chip->reg_lock);
2214

2215
	/* Remap each port's VLANTable */
2216
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
2217
		if (ds->ports[i].bridge_dev == br) {
2218
			err = _mv88e6xxx_port_based_vlan_map(chip, i);
2219 2220 2221 2222 2223
			if (err)
				break;
		}
	}

2224
	mutex_unlock(&chip->reg_lock);
2225

2226
	return err;
2227 2228
}

2229 2230
static void mv88e6xxx_port_bridge_leave(struct dsa_switch *ds, int port,
					struct net_device *br)
2231
{
V
Vivien Didelot 已提交
2232
	struct mv88e6xxx_chip *chip = ds->priv;
2233
	int i;
2234

2235
	mutex_lock(&chip->reg_lock);
2236

2237
	/* Remap each port's VLANTable */
2238
	for (i = 0; i < mv88e6xxx_num_ports(chip); ++i)
2239
		if (i == port || ds->ports[i].bridge_dev == br)
2240
			if (_mv88e6xxx_port_based_vlan_map(chip, i))
2241 2242
				netdev_warn(ds->ports[i].netdev,
					    "failed to remap\n");
2243

2244
	mutex_unlock(&chip->reg_lock);
2245 2246
}

2247 2248 2249 2250 2251 2252 2253 2254
static int mv88e6xxx_software_reset(struct mv88e6xxx_chip *chip)
{
	if (chip->info->ops->reset)
		return chip->info->ops->reset(chip);

	return 0;
}

2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267
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);
	}
}

2268
static int mv88e6xxx_disable_ports(struct mv88e6xxx_chip *chip)
2269
{
2270
	int i, err;
2271

2272
	/* Set all ports to the Disabled state */
2273
	for (i = 0; i < mv88e6xxx_num_ports(chip); i++) {
2274 2275
		err = mv88e6xxx_port_set_state(chip, i,
					       PORT_CONTROL_STATE_DISABLED);
2276 2277
		if (err)
			return err;
2278 2279
	}

2280 2281 2282
	/* Wait for transmit queues to drain,
	 * i.e. 2ms for a maximum frame to be transmitted at 10 Mbps.
	 */
2283 2284
	usleep_range(2000, 4000);

2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295
	return 0;
}

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

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

2296
	mv88e6xxx_hardware_reset(chip);
2297

2298
	return mv88e6xxx_software_reset(chip);
2299 2300
}

2301
static int mv88e6xxx_serdes_power_on(struct mv88e6xxx_chip *chip)
2302
{
2303 2304
	u16 val;
	int err;
2305

2306 2307 2308 2309
	/* Clear Power Down bit */
	err = mv88e6xxx_serdes_read(chip, MII_BMCR, &val);
	if (err)
		return err;
2310

2311 2312 2313
	if (val & BMCR_PDOWN) {
		val &= ~BMCR_PDOWN;
		err = mv88e6xxx_serdes_write(chip, MII_BMCR, val);
2314 2315
	}

2316
	return err;
2317 2318
}

2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384
static int mv88e6xxx_setup_port_dsa(struct mv88e6xxx_chip *chip, int port,
				    int upstream_port)
{
	int err;

	err = chip->info->ops->port_set_frame_mode(
		chip, port, MV88E6XXX_FRAME_MODE_DSA);
	if (err)
		return err;

	return chip->info->ops->port_set_egress_unknowns(
		chip, port, port == upstream_port);
}

static int mv88e6xxx_setup_port_cpu(struct mv88e6xxx_chip *chip, int port)
{
	int err;

	switch (chip->info->tag_protocol) {
	case DSA_TAG_PROTO_EDSA:
		err = chip->info->ops->port_set_frame_mode(
			chip, port, MV88E6XXX_FRAME_MODE_ETHERTYPE);
		if (err)
			return err;

		err = mv88e6xxx_port_set_egress_mode(
			chip, port, PORT_CONTROL_EGRESS_ADD_TAG);
		if (err)
			return err;

		if (chip->info->ops->port_set_ether_type)
			err = chip->info->ops->port_set_ether_type(
				chip, port, ETH_P_EDSA);
		break;

	case DSA_TAG_PROTO_DSA:
		err = chip->info->ops->port_set_frame_mode(
			chip, port, MV88E6XXX_FRAME_MODE_DSA);
		if (err)
			return err;

		err = mv88e6xxx_port_set_egress_mode(
			chip, port, PORT_CONTROL_EGRESS_UNMODIFIED);
		break;
	default:
		err = -EINVAL;
	}

	if (err)
		return err;

	return chip->info->ops->port_set_egress_unknowns(chip, port, true);
}

static int mv88e6xxx_setup_port_normal(struct mv88e6xxx_chip *chip, int port)
{
	int err;

	err = chip->info->ops->port_set_frame_mode(
		chip, port, MV88E6XXX_FRAME_MODE_NORMAL);
	if (err)
		return err;

	return chip->info->ops->port_set_egress_unknowns(chip, port, false);
}

2385 2386 2387 2388 2389 2390 2391
static int mv88e6xxx_setup_message_port(struct mv88e6xxx_chip *chip, int port)
{
	bool message = dsa_is_dsa_port(chip->ds, port);

	return mv88e6xxx_port_set_message_port(chip, port, message);
}

2392
static int mv88e6xxx_setup_port(struct mv88e6xxx_chip *chip, int port)
2393
{
2394
	struct dsa_switch *ds = chip->ds;
2395
	int err;
2396
	u16 reg;
2397

2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411
	/* 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;
2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426

	/* 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.
	 */
2427
	reg = PORT_CONTROL_IGMP_MLD_SNOOP |
2428 2429
		PORT_CONTROL_USE_TAG | PORT_CONTROL_USE_IP |
		PORT_CONTROL_STATE_FORWARDING;
2430 2431 2432
	err = mv88e6xxx_port_write(chip, port, PORT_CONTROL, reg);
	if (err)
		return err;
2433

2434 2435 2436 2437 2438 2439 2440
	if (dsa_is_cpu_port(ds, port)) {
		err = mv88e6xxx_setup_port_cpu(chip, port);
	} else if (dsa_is_dsa_port(ds, port)) {
		err = mv88e6xxx_setup_port_dsa(chip, port,
					       dsa_upstream_port(ds));
	} else {
		err = mv88e6xxx_setup_port_normal(chip, port);
2441
	}
2442 2443
	if (err)
		return err;
2444

2445 2446 2447
	/* If this port is connected to a SerDes, make sure the SerDes is not
	 * powered down.
	 */
2448
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAGS_SERDES)) {
2449 2450 2451 2452 2453 2454 2455 2456 2457 2458
		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;
2459 2460 2461
		}
	}

2462
	/* Port Control 2: don't force a good FCS, set the maximum frame size to
2463
	 * 10240 bytes, disable 802.1q tags checking, don't discard tagged or
2464 2465 2466
	 * 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.
2467
	 */
2468 2469 2470
	err = mv88e6xxx_port_set_map_da(chip, port);
	if (err)
		return err;
2471

2472 2473 2474 2475
	reg = 0;
	if (chip->info->ops->port_set_upstream_port) {
		err = chip->info->ops->port_set_upstream_port(
			chip, port, dsa_upstream_port(ds));
2476 2477
		if (err)
			return err;
2478 2479
	}

2480 2481 2482 2483 2484
	err = mv88e6xxx_port_set_8021q_mode(chip, port,
					    PORT_CONTROL_2_8021Q_DISABLED);
	if (err)
		return err;

2485 2486 2487 2488 2489 2490
	if (chip->info->ops->port_jumbo_config) {
		err = chip->info->ops->port_jumbo_config(chip, port);
		if (err)
			return err;
	}

2491 2492 2493 2494 2495
	/* 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.
	 */
2496
	reg = 1 << port;
2497 2498
	/* Disable learning for CPU port */
	if (dsa_is_cpu_port(ds, port))
2499
		reg = 0;
2500

2501 2502 2503
	err = mv88e6xxx_port_write(chip, port, PORT_ASSOC_VECTOR, reg);
	if (err)
		return err;
2504 2505

	/* Egress rate control 2: disable egress rate control. */
2506 2507 2508
	err = mv88e6xxx_port_write(chip, port, PORT_RATE_CONTROL_2, 0x0000);
	if (err)
		return err;
2509

2510 2511
	if (chip->info->ops->port_pause_config) {
		err = chip->info->ops->port_pause_config(chip, port);
2512 2513
		if (err)
			return err;
2514
	}
2515

2516 2517
	if (mv88e6xxx_6352_family(chip) || mv88e6xxx_6351_family(chip) ||
	    mv88e6xxx_6165_family(chip) || mv88e6xxx_6097_family(chip) ||
2518
	    mv88e6xxx_6320_family(chip) || mv88e6xxx_6341_family(chip)) {
2519 2520 2521 2522
		/* Port ATU control: disable limiting the number of
		 * address database entries that this port is allowed
		 * to use.
		 */
2523 2524
		err = mv88e6xxx_port_write(chip, port, PORT_ATU_CONTROL,
					   0x0000);
2525 2526 2527
		/* Priority Override: disable DA, SA and VTU priority
		 * override.
		 */
2528 2529 2530 2531
		err = mv88e6xxx_port_write(chip, port, PORT_PRI_OVERRIDE,
					   0x0000);
		if (err)
			return err;
2532
	}
2533

2534 2535
	if (chip->info->ops->port_tag_remap) {
		err = chip->info->ops->port_tag_remap(chip, port);
2536 2537
		if (err)
			return err;
2538 2539
	}

2540 2541
	if (chip->info->ops->port_egress_rate_limiting) {
		err = chip->info->ops->port_egress_rate_limiting(chip, port);
2542 2543
		if (err)
			return err;
2544 2545
	}

2546
	err = mv88e6xxx_setup_message_port(chip, port);
2547 2548
	if (err)
		return err;
2549

2550
	/* Port based VLAN map: give each port the same default address
2551 2552
	 * database, and allow bidirectional communication between the
	 * CPU and DSA port(s), and the other ports.
2553
	 */
2554
	err = mv88e6xxx_port_set_fid(chip, port, 0);
2555 2556
	if (err)
		return err;
2557

2558 2559 2560
	err = _mv88e6xxx_port_based_vlan_map(chip, port);
	if (err)
		return err;
2561 2562 2563 2564

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

2568
static int mv88e6xxx_g1_set_switch_mac(struct mv88e6xxx_chip *chip, u8 *addr)
2569 2570 2571
{
	int err;

2572
	err = mv88e6xxx_g1_write(chip, GLOBAL_MAC_01, (addr[0] << 8) | addr[1]);
2573 2574 2575
	if (err)
		return err;

2576
	err = mv88e6xxx_g1_write(chip, GLOBAL_MAC_23, (addr[2] << 8) | addr[3]);
2577 2578 2579
	if (err)
		return err;

2580 2581 2582 2583 2584
	err = mv88e6xxx_g1_write(chip, GLOBAL_MAC_45, (addr[4] << 8) | addr[5]);
	if (err)
		return err;

	return 0;
2585 2586
}

2587 2588 2589
static int mv88e6xxx_set_ageing_time(struct dsa_switch *ds,
				     unsigned int ageing_time)
{
V
Vivien Didelot 已提交
2590
	struct mv88e6xxx_chip *chip = ds->priv;
2591 2592 2593
	int err;

	mutex_lock(&chip->reg_lock);
2594
	err = mv88e6xxx_g1_atu_set_age_time(chip, ageing_time);
2595 2596 2597 2598 2599
	mutex_unlock(&chip->reg_lock);

	return err;
}

2600
static int mv88e6xxx_g1_setup(struct mv88e6xxx_chip *chip)
2601
{
2602
	struct dsa_switch *ds = chip->ds;
2603
	u32 upstream_port = dsa_upstream_port(ds);
2604
	int err;
2605

2606 2607 2608
	/* Enable the PHY Polling Unit if present, don't discard any packets,
	 * and mask all interrupt sources.
	 */
2609
	err = mv88e6xxx_ppu_enable(chip);
2610 2611 2612
	if (err)
		return err;

2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623
	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;
	}
2624

2625
	/* Disable remote management, and set the switch's DSA device number. */
2626 2627 2628
	err = mv88e6xxx_g1_write(chip, GLOBAL_CONTROL_2,
				 GLOBAL_CONTROL_2_MULTIPLE_CASCADE |
				 (ds->index & 0x1f));
2629 2630 2631
	if (err)
		return err;

2632 2633 2634 2635 2636
	/* Clear all the VTU and STU entries */
	err = _mv88e6xxx_vtu_stu_flush(chip);
	if (err < 0)
		return err;

2637 2638 2639 2640 2641
	/* Clear all ATU entries */
	err = _mv88e6xxx_atu_flush(chip, 0, true);
	if (err)
		return err;

2642
	/* Configure the IP ToS mapping registers. */
2643
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_0, 0x0000);
2644
	if (err)
2645
		return err;
2646
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_1, 0x0000);
2647
	if (err)
2648
		return err;
2649
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_2, 0x5555);
2650
	if (err)
2651
		return err;
2652
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_3, 0x5555);
2653
	if (err)
2654
		return err;
2655
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_4, 0xaaaa);
2656
	if (err)
2657
		return err;
2658
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_5, 0xaaaa);
2659
	if (err)
2660
		return err;
2661
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_6, 0xffff);
2662
	if (err)
2663
		return err;
2664
	err = mv88e6xxx_g1_write(chip, GLOBAL_IP_PRI_7, 0xffff);
2665
	if (err)
2666
		return err;
2667 2668

	/* Configure the IEEE 802.1p priority mapping register. */
2669
	err = mv88e6xxx_g1_write(chip, GLOBAL_IEEE_PRI, 0xfa41);
2670
	if (err)
2671
		return err;
2672

2673 2674 2675 2676 2677
	/* Initialize the statistics unit */
	err = mv88e6xxx_stats_set_histogram(chip);
	if (err)
		return err;

2678
	/* Clear the statistics counters for all ports */
2679 2680
	err = mv88e6xxx_g1_write(chip, GLOBAL_STATS_OP,
				 GLOBAL_STATS_OP_FLUSH_ALL);
2681 2682 2683 2684
	if (err)
		return err;

	/* Wait for the flush to complete. */
2685
	err = mv88e6xxx_g1_stats_wait(chip);
2686 2687 2688 2689 2690 2691
	if (err)
		return err;

	return 0;
}

2692
static int mv88e6xxx_setup(struct dsa_switch *ds)
2693
{
V
Vivien Didelot 已提交
2694
	struct mv88e6xxx_chip *chip = ds->priv;
2695
	int err;
2696 2697
	int i;

2698
	chip->ds = ds;
2699
	ds->slave_mii_bus = mv88e6xxx_default_mdio_bus(chip);
2700

2701
	mutex_lock(&chip->reg_lock);
2702

2703
	/* Setup Switch Port Registers */
2704
	for (i = 0; i < mv88e6xxx_num_ports(chip); i++) {
2705 2706 2707 2708 2709 2710 2711
		err = mv88e6xxx_setup_port(chip, i);
		if (err)
			goto unlock;
	}

	/* Setup Switch Global 1 Registers */
	err = mv88e6xxx_g1_setup(chip);
2712 2713 2714
	if (err)
		goto unlock;

2715 2716 2717
	/* Setup Switch Global 2 Registers */
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_GLOBAL2)) {
		err = mv88e6xxx_g2_setup(chip);
2718 2719 2720
		if (err)
			goto unlock;
	}
2721

2722 2723 2724 2725
	err = mv88e6xxx_atu_setup(chip);
	if (err)
		goto unlock;

2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736
	/* 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;
	}

2737
unlock:
2738
	mutex_unlock(&chip->reg_lock);
2739

2740
	return err;
2741 2742
}

2743 2744
static int mv88e6xxx_set_addr(struct dsa_switch *ds, u8 *addr)
{
V
Vivien Didelot 已提交
2745
	struct mv88e6xxx_chip *chip = ds->priv;
2746 2747
	int err;

2748 2749
	if (!chip->info->ops->set_switch_mac)
		return -EOPNOTSUPP;
2750

2751 2752
	mutex_lock(&chip->reg_lock);
	err = chip->info->ops->set_switch_mac(chip, addr);
2753 2754 2755 2756 2757
	mutex_unlock(&chip->reg_lock);

	return err;
}

2758
static int mv88e6xxx_mdio_read(struct mii_bus *bus, int phy, int reg)
2759
{
2760 2761
	struct mv88e6xxx_mdio_bus *mdio_bus = bus->priv;
	struct mv88e6xxx_chip *chip = mdio_bus->chip;
2762 2763
	u16 val;
	int err;
2764

2765 2766 2767
	if (!chip->info->ops->phy_read)
		return -EOPNOTSUPP;

2768
	mutex_lock(&chip->reg_lock);
2769
	err = chip->info->ops->phy_read(chip, bus, phy, reg, &val);
2770
	mutex_unlock(&chip->reg_lock);
2771

2772 2773 2774 2775 2776 2777 2778 2779
	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;
	}

2780
	return err ? err : val;
2781 2782
}

2783
static int mv88e6xxx_mdio_write(struct mii_bus *bus, int phy, int reg, u16 val)
2784
{
2785 2786
	struct mv88e6xxx_mdio_bus *mdio_bus = bus->priv;
	struct mv88e6xxx_chip *chip = mdio_bus->chip;
2787
	int err;
2788

2789 2790 2791
	if (!chip->info->ops->phy_write)
		return -EOPNOTSUPP;

2792
	mutex_lock(&chip->reg_lock);
2793
	err = chip->info->ops->phy_write(chip, bus, phy, reg, val);
2794
	mutex_unlock(&chip->reg_lock);
2795 2796

	return err;
2797 2798
}

2799
static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip *chip,
2800 2801
				   struct device_node *np,
				   bool external)
2802 2803
{
	static int index;
2804
	struct mv88e6xxx_mdio_bus *mdio_bus;
2805 2806 2807
	struct mii_bus *bus;
	int err;

2808
	bus = devm_mdiobus_alloc_size(chip->dev, sizeof(*mdio_bus));
2809 2810 2811
	if (!bus)
		return -ENOMEM;

2812
	mdio_bus = bus->priv;
2813
	mdio_bus->bus = bus;
2814
	mdio_bus->chip = chip;
2815 2816
	INIT_LIST_HEAD(&mdio_bus->list);
	mdio_bus->external = external;
2817

2818 2819 2820 2821 2822 2823 2824 2825 2826 2827
	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;
2828
	bus->parent = chip->dev;
2829

2830 2831
	if (np)
		err = of_mdiobus_register(bus, np);
2832 2833 2834
	else
		err = mdiobus_register(bus);
	if (err) {
2835
		dev_err(chip->dev, "Cannot register MDIO bus (%d)\n", err);
2836
		return err;
2837
	}
2838 2839 2840 2841 2842

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

	return 0;
2845
}
2846

2847 2848 2849 2850 2851
static const struct of_device_id mv88e6xxx_mdio_external_match[] = {
	{ .compatible = "marvell,mv88e6xxx-mdio-external",
	  .data = (void *)true },
	{ },
};
2852

2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882
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;
2883 2884
}

2885
static void mv88e6xxx_mdios_unregister(struct mv88e6xxx_chip *chip)
2886 2887

{
2888 2889
	struct mv88e6xxx_mdio_bus *mdio_bus;
	struct mii_bus *bus;
2890

2891 2892
	list_for_each_entry(mdio_bus, &chip->mdios, list) {
		bus = mdio_bus->bus;
2893

2894 2895
		mdiobus_unregister(bus);
	}
2896 2897
}

2898 2899
static int mv88e6xxx_get_eeprom_len(struct dsa_switch *ds)
{
V
Vivien Didelot 已提交
2900
	struct mv88e6xxx_chip *chip = ds->priv;
2901 2902 2903 2904 2905 2906 2907

	return chip->eeprom_len;
}

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

2911 2912
	if (!chip->info->ops->get_eeprom)
		return -EOPNOTSUPP;
2913

2914 2915
	mutex_lock(&chip->reg_lock);
	err = chip->info->ops->get_eeprom(chip, eeprom, data);
2916 2917 2918 2919 2920 2921 2922 2923 2924 2925 2926 2927 2928
	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 已提交
2929
	struct mv88e6xxx_chip *chip = ds->priv;
2930 2931
	int err;

2932 2933 2934
	if (!chip->info->ops->set_eeprom)
		return -EOPNOTSUPP;

2935 2936 2937 2938
	if (eeprom->magic != 0xc3ec4951)
		return -EINVAL;

	mutex_lock(&chip->reg_lock);
2939
	err = chip->info->ops->set_eeprom(chip, eeprom, data);
2940 2941 2942 2943 2944
	mutex_unlock(&chip->reg_lock);

	return err;
}

2945
static const struct mv88e6xxx_ops mv88e6085_ops = {
2946
	/* MV88E6XXX_FAMILY_6097 */
2947
	.set_switch_mac = mv88e6xxx_g1_set_switch_mac,
2948 2949
	.phy_read = mv88e6xxx_phy_ppu_read,
	.phy_write = mv88e6xxx_phy_ppu_write,
2950
	.port_set_link = mv88e6xxx_port_set_link,
2951
	.port_set_duplex = mv88e6xxx_port_set_duplex,
2952
	.port_set_speed = mv88e6185_port_set_speed,
2953
	.port_tag_remap = mv88e6095_port_tag_remap,
2954 2955 2956
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
2957
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
2958
	.port_pause_config = mv88e6097_port_pause_config,
2959
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
2960 2961
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
2962
	.stats_get_stats = mv88e6095_stats_get_stats,
2963 2964
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
2965
	.watchdog_ops = &mv88e6097_watchdog_ops,
2966
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
2967 2968
	.ppu_enable = mv88e6185_g1_ppu_enable,
	.ppu_disable = mv88e6185_g1_ppu_disable,
2969
	.reset = mv88e6185_g1_reset,
2970 2971 2972
};

static const struct mv88e6xxx_ops mv88e6095_ops = {
2973
	/* MV88E6XXX_FAMILY_6095 */
2974
	.set_switch_mac = mv88e6xxx_g1_set_switch_mac,
2975 2976
	.phy_read = mv88e6xxx_phy_ppu_read,
	.phy_write = mv88e6xxx_phy_ppu_write,
2977
	.port_set_link = mv88e6xxx_port_set_link,
2978
	.port_set_duplex = mv88e6xxx_port_set_duplex,
2979
	.port_set_speed = mv88e6185_port_set_speed,
2980
	.port_set_frame_mode = mv88e6085_port_set_frame_mode,
2981 2982
	.port_set_egress_unknowns = mv88e6095_port_set_egress_unknowns,
	.port_set_upstream_port = mv88e6095_port_set_upstream_port,
2983
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
2984 2985
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
2986
	.stats_get_stats = mv88e6095_stats_get_stats,
2987
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
2988 2989
	.ppu_enable = mv88e6185_g1_ppu_enable,
	.ppu_disable = mv88e6185_g1_ppu_disable,
2990
	.reset = mv88e6185_g1_reset,
2991 2992
};

2993
static const struct mv88e6xxx_ops mv88e6097_ops = {
2994
	/* MV88E6XXX_FAMILY_6097 */
2995 2996 2997 2998 2999 3000
	.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,
3001
	.port_tag_remap = mv88e6095_port_tag_remap,
3002 3003 3004
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3005
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3006
	.port_egress_rate_limiting = mv88e6095_port_egress_rate_limiting,
3007
	.port_pause_config = mv88e6097_port_pause_config,
3008 3009 3010 3011
	.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,
3012 3013
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3014
	.watchdog_ops = &mv88e6097_watchdog_ops,
3015
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3016
	.reset = mv88e6352_g1_reset,
3017 3018
};

3019
static const struct mv88e6xxx_ops mv88e6123_ops = {
3020
	/* MV88E6XXX_FAMILY_6165 */
3021
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3022 3023
	.phy_read = mv88e6165_phy_read,
	.phy_write = mv88e6165_phy_write,
3024
	.port_set_link = mv88e6xxx_port_set_link,
3025
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3026
	.port_set_speed = mv88e6185_port_set_speed,
3027 3028
	.port_set_frame_mode = mv88e6085_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6085_port_set_egress_unknowns,
3029
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
3030 3031
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3032
	.stats_get_stats = mv88e6095_stats_get_stats,
3033 3034
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3035
	.watchdog_ops = &mv88e6097_watchdog_ops,
3036
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3037
	.reset = mv88e6352_g1_reset,
3038 3039 3040
};

static const struct mv88e6xxx_ops mv88e6131_ops = {
3041
	/* MV88E6XXX_FAMILY_6185 */
3042
	.set_switch_mac = mv88e6xxx_g1_set_switch_mac,
3043 3044
	.phy_read = mv88e6xxx_phy_ppu_read,
	.phy_write = mv88e6xxx_phy_ppu_write,
3045
	.port_set_link = mv88e6xxx_port_set_link,
3046
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3047
	.port_set_speed = mv88e6185_port_set_speed,
3048
	.port_tag_remap = mv88e6095_port_tag_remap,
3049
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
3050
	.port_set_egress_unknowns = mv88e6095_port_set_egress_unknowns,
3051
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3052
	.port_set_upstream_port = mv88e6095_port_set_upstream_port,
3053
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3054
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3055
	.port_pause_config = mv88e6097_port_pause_config,
3056
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
3057 3058
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3059
	.stats_get_stats = mv88e6095_stats_get_stats,
3060 3061
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3062
	.watchdog_ops = &mv88e6097_watchdog_ops,
3063
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3064 3065
	.ppu_enable = mv88e6185_g1_ppu_enable,
	.ppu_disable = mv88e6185_g1_ppu_disable,
3066
	.reset = mv88e6185_g1_reset,
3067 3068 3069
};

static const struct mv88e6xxx_ops mv88e6161_ops = {
3070
	/* MV88E6XXX_FAMILY_6165 */
3071
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3072 3073
	.phy_read = mv88e6165_phy_read,
	.phy_write = mv88e6165_phy_write,
3074
	.port_set_link = mv88e6xxx_port_set_link,
3075
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3076
	.port_set_speed = mv88e6185_port_set_speed,
3077
	.port_tag_remap = mv88e6095_port_tag_remap,
3078 3079 3080
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3081
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3082
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3083
	.port_pause_config = mv88e6097_port_pause_config,
3084
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
3085 3086
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3087
	.stats_get_stats = mv88e6095_stats_get_stats,
3088 3089
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3090
	.watchdog_ops = &mv88e6097_watchdog_ops,
3091
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3092
	.reset = mv88e6352_g1_reset,
3093 3094 3095
};

static const struct mv88e6xxx_ops mv88e6165_ops = {
3096
	/* MV88E6XXX_FAMILY_6165 */
3097
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3098 3099
	.phy_read = mv88e6165_phy_read,
	.phy_write = mv88e6165_phy_write,
3100
	.port_set_link = mv88e6xxx_port_set_link,
3101
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3102
	.port_set_speed = mv88e6185_port_set_speed,
3103
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
3104 3105
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3106
	.stats_get_stats = mv88e6095_stats_get_stats,
3107 3108
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3109
	.watchdog_ops = &mv88e6097_watchdog_ops,
3110
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3111
	.reset = mv88e6352_g1_reset,
3112 3113 3114
};

static const struct mv88e6xxx_ops mv88e6171_ops = {
3115
	/* MV88E6XXX_FAMILY_6351 */
3116
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3117 3118
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3119
	.port_set_link = mv88e6xxx_port_set_link,
3120
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3121
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3122
	.port_set_speed = mv88e6185_port_set_speed,
3123
	.port_tag_remap = mv88e6095_port_tag_remap,
3124 3125 3126
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3127
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3128
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3129
	.port_pause_config = mv88e6097_port_pause_config,
3130
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3131 3132
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3133
	.stats_get_stats = mv88e6095_stats_get_stats,
3134 3135
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3136
	.watchdog_ops = &mv88e6097_watchdog_ops,
3137
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3138
	.reset = mv88e6352_g1_reset,
3139 3140 3141
};

static const struct mv88e6xxx_ops mv88e6172_ops = {
3142
	/* MV88E6XXX_FAMILY_6352 */
3143 3144
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3145
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3146 3147
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3148
	.port_set_link = mv88e6xxx_port_set_link,
3149
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3150
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3151
	.port_set_speed = mv88e6352_port_set_speed,
3152
	.port_tag_remap = mv88e6095_port_tag_remap,
3153 3154 3155
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3156
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3157
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3158
	.port_pause_config = mv88e6097_port_pause_config,
3159
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3160 3161
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3162
	.stats_get_stats = mv88e6095_stats_get_stats,
3163 3164
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3165
	.watchdog_ops = &mv88e6097_watchdog_ops,
3166
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3167
	.reset = mv88e6352_g1_reset,
3168 3169 3170
};

static const struct mv88e6xxx_ops mv88e6175_ops = {
3171
	/* MV88E6XXX_FAMILY_6351 */
3172
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3173 3174
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3175
	.port_set_link = mv88e6xxx_port_set_link,
3176
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3177
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3178
	.port_set_speed = mv88e6185_port_set_speed,
3179
	.port_tag_remap = mv88e6095_port_tag_remap,
3180 3181 3182
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3183
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3184
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3185
	.port_pause_config = mv88e6097_port_pause_config,
3186
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3187 3188
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3189
	.stats_get_stats = mv88e6095_stats_get_stats,
3190 3191
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3192
	.watchdog_ops = &mv88e6097_watchdog_ops,
3193
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3194
	.reset = mv88e6352_g1_reset,
3195 3196 3197
};

static const struct mv88e6xxx_ops mv88e6176_ops = {
3198
	/* MV88E6XXX_FAMILY_6352 */
3199 3200
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3201
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3202 3203
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3204
	.port_set_link = mv88e6xxx_port_set_link,
3205
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3206
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3207
	.port_set_speed = mv88e6352_port_set_speed,
3208
	.port_tag_remap = mv88e6095_port_tag_remap,
3209 3210 3211
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3212
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3213
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3214
	.port_pause_config = mv88e6097_port_pause_config,
3215
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3216 3217
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3218
	.stats_get_stats = mv88e6095_stats_get_stats,
3219 3220
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3221
	.watchdog_ops = &mv88e6097_watchdog_ops,
3222
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3223
	.reset = mv88e6352_g1_reset,
3224 3225 3226
};

static const struct mv88e6xxx_ops mv88e6185_ops = {
3227
	/* MV88E6XXX_FAMILY_6185 */
3228
	.set_switch_mac = mv88e6xxx_g1_set_switch_mac,
3229 3230
	.phy_read = mv88e6xxx_phy_ppu_read,
	.phy_write = mv88e6xxx_phy_ppu_write,
3231
	.port_set_link = mv88e6xxx_port_set_link,
3232
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3233
	.port_set_speed = mv88e6185_port_set_speed,
3234
	.port_set_frame_mode = mv88e6085_port_set_frame_mode,
3235
	.port_set_egress_unknowns = mv88e6095_port_set_egress_unknowns,
3236
	.port_egress_rate_limiting = mv88e6095_port_egress_rate_limiting,
3237
	.port_set_upstream_port = mv88e6095_port_set_upstream_port,
3238
	.stats_snapshot = mv88e6xxx_g1_stats_snapshot,
3239 3240
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3241
	.stats_get_stats = mv88e6095_stats_get_stats,
3242 3243
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3244
	.watchdog_ops = &mv88e6097_watchdog_ops,
3245
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3246 3247
	.ppu_enable = mv88e6185_g1_ppu_enable,
	.ppu_disable = mv88e6185_g1_ppu_disable,
3248
	.reset = mv88e6185_g1_reset,
3249 3250
};

3251
static const struct mv88e6xxx_ops mv88e6190_ops = {
3252
	/* MV88E6XXX_FAMILY_6390 */
3253 3254
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3255 3256 3257 3258 3259 3260 3261
	.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,
3262
	.port_tag_remap = mv88e6390_port_tag_remap,
3263 3264 3265
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3266
	.port_pause_config = mv88e6390_port_pause_config,
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 mv88e6190x_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 = mv88e6390x_port_set_speed,
3290
	.port_tag_remap = mv88e6390_port_tag_remap,
3291 3292 3293
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3294
	.port_pause_config = mv88e6390_port_pause_config,
3295
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3296
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3297 3298
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3299
	.stats_get_stats = mv88e6390_stats_get_stats,
3300 3301
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3302
	.watchdog_ops = &mv88e6390_watchdog_ops,
3303
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3304
	.reset = mv88e6352_g1_reset,
3305 3306 3307
};

static const struct mv88e6xxx_ops mv88e6191_ops = {
3308
	/* MV88E6XXX_FAMILY_6390 */
3309 3310
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3311 3312 3313 3314 3315 3316 3317
	.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,
3318
	.port_tag_remap = mv88e6390_port_tag_remap,
3319 3320 3321
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3322
	.port_pause_config = mv88e6390_port_pause_config,
3323
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3324
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3325 3326
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3327
	.stats_get_stats = mv88e6390_stats_get_stats,
3328 3329
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3330
	.watchdog_ops = &mv88e6390_watchdog_ops,
3331
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3332
	.reset = mv88e6352_g1_reset,
3333 3334
};

3335
static const struct mv88e6xxx_ops mv88e6240_ops = {
3336
	/* MV88E6XXX_FAMILY_6352 */
3337 3338
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3339
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3340 3341
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3342
	.port_set_link = mv88e6xxx_port_set_link,
3343
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3344
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3345
	.port_set_speed = mv88e6352_port_set_speed,
3346
	.port_tag_remap = mv88e6095_port_tag_remap,
3347 3348 3349
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3350
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3351
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3352
	.port_pause_config = mv88e6097_port_pause_config,
3353
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3354 3355
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3356
	.stats_get_stats = mv88e6095_stats_get_stats,
3357 3358
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3359
	.watchdog_ops = &mv88e6097_watchdog_ops,
3360
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3361
	.reset = mv88e6352_g1_reset,
3362 3363
};

3364
static const struct mv88e6xxx_ops mv88e6290_ops = {
3365
	/* MV88E6XXX_FAMILY_6390 */
3366 3367
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3368 3369 3370 3371 3372 3373 3374
	.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,
3375
	.port_tag_remap = mv88e6390_port_tag_remap,
3376 3377 3378
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3379
	.port_pause_config = mv88e6390_port_pause_config,
3380
	.port_set_cmode = mv88e6390x_port_set_cmode,
3381
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3382
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3383 3384
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3385
	.stats_get_stats = mv88e6390_stats_get_stats,
3386 3387
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3388
	.watchdog_ops = &mv88e6390_watchdog_ops,
3389
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3390
	.reset = mv88e6352_g1_reset,
3391 3392
};

3393
static const struct mv88e6xxx_ops mv88e6320_ops = {
3394
	/* MV88E6XXX_FAMILY_6320 */
3395 3396
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3397
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3398 3399
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3400
	.port_set_link = mv88e6xxx_port_set_link,
3401
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3402
	.port_set_speed = mv88e6185_port_set_speed,
3403
	.port_tag_remap = mv88e6095_port_tag_remap,
3404 3405 3406
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3407
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3408
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3409
	.port_pause_config = mv88e6097_port_pause_config,
3410
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3411 3412
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3413
	.stats_get_stats = mv88e6320_stats_get_stats,
3414 3415
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3416
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3417
	.reset = mv88e6352_g1_reset,
3418 3419 3420
};

static const struct mv88e6xxx_ops mv88e6321_ops = {
3421
	/* MV88E6XXX_FAMILY_6321 */
3422 3423
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3424
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3425 3426
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3427
	.port_set_link = mv88e6xxx_port_set_link,
3428
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3429
	.port_set_speed = mv88e6185_port_set_speed,
3430
	.port_tag_remap = mv88e6095_port_tag_remap,
3431 3432 3433
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3434
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3435
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3436
	.port_pause_config = mv88e6097_port_pause_config,
3437
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3438 3439
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3440
	.stats_get_stats = mv88e6320_stats_get_stats,
3441 3442
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3443
	.reset = mv88e6352_g1_reset,
3444 3445 3446
};

static const struct mv88e6xxx_ops mv88e6350_ops = {
3447
	/* MV88E6XXX_FAMILY_6351 */
3448
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3449 3450
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3451
	.port_set_link = mv88e6xxx_port_set_link,
3452
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3453
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3454
	.port_set_speed = mv88e6185_port_set_speed,
3455
	.port_tag_remap = mv88e6095_port_tag_remap,
3456 3457 3458
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3459
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3460
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3461
	.port_pause_config = mv88e6097_port_pause_config,
3462
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3463 3464
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3465
	.stats_get_stats = mv88e6095_stats_get_stats,
3466 3467
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3468
	.watchdog_ops = &mv88e6097_watchdog_ops,
3469
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3470
	.reset = mv88e6352_g1_reset,
3471 3472 3473
};

static const struct mv88e6xxx_ops mv88e6351_ops = {
3474
	/* MV88E6XXX_FAMILY_6351 */
3475
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3476 3477
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3478
	.port_set_link = mv88e6xxx_port_set_link,
3479
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3480
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3481
	.port_set_speed = mv88e6185_port_set_speed,
3482
	.port_tag_remap = mv88e6095_port_tag_remap,
3483 3484 3485
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3486
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3487
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3488
	.port_pause_config = mv88e6097_port_pause_config,
3489
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3490 3491
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3492
	.stats_get_stats = mv88e6095_stats_get_stats,
3493 3494
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3495
	.watchdog_ops = &mv88e6097_watchdog_ops,
3496
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3497
	.reset = mv88e6352_g1_reset,
3498 3499 3500
};

static const struct mv88e6xxx_ops mv88e6352_ops = {
3501
	/* MV88E6XXX_FAMILY_6352 */
3502 3503
	.get_eeprom = mv88e6xxx_g2_get_eeprom16,
	.set_eeprom = mv88e6xxx_g2_set_eeprom16,
3504
	.set_switch_mac = mv88e6xxx_g2_set_switch_mac,
3505 3506
	.phy_read = mv88e6xxx_g2_smi_phy_read,
	.phy_write = mv88e6xxx_g2_smi_phy_write,
3507
	.port_set_link = mv88e6xxx_port_set_link,
3508
	.port_set_duplex = mv88e6xxx_port_set_duplex,
3509
	.port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
3510
	.port_set_speed = mv88e6352_port_set_speed,
3511
	.port_tag_remap = mv88e6095_port_tag_remap,
3512 3513 3514
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3515
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3516
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3517
	.port_pause_config = mv88e6097_port_pause_config,
3518
	.stats_snapshot = mv88e6320_g1_stats_snapshot,
3519 3520
	.stats_get_sset_count = mv88e6095_stats_get_sset_count,
	.stats_get_strings = mv88e6095_stats_get_strings,
3521
	.stats_get_stats = mv88e6095_stats_get_stats,
3522 3523
	.g1_set_cpu_port = mv88e6095_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6095_g1_set_egress_port,
3524
	.watchdog_ops = &mv88e6097_watchdog_ops,
3525
	.mgmt_rsvd2cpu = mv88e6095_g2_mgmt_rsvd2cpu,
3526
	.reset = mv88e6352_g1_reset,
3527 3528
};

3529 3530 3531 3532 3533 3534 3535 3536 3537 3538 3539 3540 3541 3542 3543 3544 3545 3546 3547 3548 3549 3550 3551 3552
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_unknowns = mv88e6351_port_set_egress_unknowns,
	.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,
	.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,
3553
	.watchdog_ops = &mv88e6390_watchdog_ops,
3554 3555 3556 3557
	.mgmt_rsvd2cpu =  mv88e6390_g1_mgmt_rsvd2cpu,
	.reset = mv88e6352_g1_reset,
};

3558 3559 3560 3561 3562 3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577 3578 3579 3580 3581
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_unknowns = mv88e6351_port_set_egress_unknowns,
	.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,
	.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,
3582
	.watchdog_ops = &mv88e6390_watchdog_ops,
3583 3584 3585 3586
	.mgmt_rsvd2cpu =  mv88e6390_g1_mgmt_rsvd2cpu,
	.reset = mv88e6352_g1_reset,
};

3587
static const struct mv88e6xxx_ops mv88e6390_ops = {
3588
	/* MV88E6XXX_FAMILY_6390 */
3589 3590
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3591 3592 3593 3594 3595 3596 3597
	.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,
3598
	.port_tag_remap = mv88e6390_port_tag_remap,
3599 3600 3601
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3602
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3603
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3604
	.port_pause_config = mv88e6390_port_pause_config,
3605
	.port_set_cmode = mv88e6390x_port_set_cmode,
3606
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3607
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3608 3609
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3610
	.stats_get_stats = mv88e6390_stats_get_stats,
3611 3612
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3613
	.watchdog_ops = &mv88e6390_watchdog_ops,
3614
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3615
	.reset = mv88e6352_g1_reset,
3616 3617 3618
};

static const struct mv88e6xxx_ops mv88e6390x_ops = {
3619
	/* MV88E6XXX_FAMILY_6390 */
3620 3621
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3622 3623 3624 3625 3626 3627 3628
	.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,
3629
	.port_tag_remap = mv88e6390_port_tag_remap,
3630 3631 3632
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3633
	.port_jumbo_config = mv88e6165_port_jumbo_config,
3634
	.port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
3635
	.port_pause_config = mv88e6390_port_pause_config,
3636
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3637
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3638 3639
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3640
	.stats_get_stats = mv88e6390_stats_get_stats,
3641 3642
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3643
	.watchdog_ops = &mv88e6390_watchdog_ops,
3644
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3645
	.reset = mv88e6352_g1_reset,
3646 3647 3648
};

static const struct mv88e6xxx_ops mv88e6391_ops = {
3649
	/* MV88E6XXX_FAMILY_6390 */
3650 3651
	.get_eeprom = mv88e6xxx_g2_get_eeprom8,
	.set_eeprom = mv88e6xxx_g2_set_eeprom8,
3652 3653 3654 3655 3656 3657 3658
	.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,
3659
	.port_tag_remap = mv88e6390_port_tag_remap,
3660 3661 3662
	.port_set_frame_mode = mv88e6351_port_set_frame_mode,
	.port_set_egress_unknowns = mv88e6351_port_set_egress_unknowns,
	.port_set_ether_type = mv88e6351_port_set_ether_type,
3663
	.port_pause_config = mv88e6390_port_pause_config,
3664
	.stats_snapshot = mv88e6390_g1_stats_snapshot,
3665
	.stats_set_histogram = mv88e6390_g1_stats_set_histogram,
3666 3667
	.stats_get_sset_count = mv88e6320_stats_get_sset_count,
	.stats_get_strings = mv88e6320_stats_get_strings,
3668
	.stats_get_stats = mv88e6390_stats_get_stats,
3669 3670
	.g1_set_cpu_port = mv88e6390_g1_set_cpu_port,
	.g1_set_egress_port = mv88e6390_g1_set_egress_port,
3671
	.watchdog_ops = &mv88e6390_watchdog_ops,
3672
	.mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
3673
	.reset = mv88e6352_g1_reset,
3674 3675
};

3676 3677 3678 3679 3680 3681 3682 3683 3684 3685 3686 3687 3688 3689 3690 3691
static int mv88e6xxx_verify_madatory_ops(struct mv88e6xxx_chip *chip,
					 const struct mv88e6xxx_ops *ops)
{
	if (!ops->port_set_frame_mode) {
		dev_err(chip->dev, "Missing port_set_frame_mode");
		return -EINVAL;
	}

	if (!ops->port_set_egress_unknowns) {
		dev_err(chip->dev, "Missing port_set_egress_mode");
		return -EINVAL;
	}

	return 0;
}

3692 3693 3694 3695 3696 3697 3698
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,
3699
		.port_base_addr = 0x10,
3700
		.global1_addr = 0x1b,
3701
		.age_time_coeff = 15000,
3702
		.g1_irqs = 8,
3703
		.tag_protocol = DSA_TAG_PROTO_DSA,
3704
		.flags = MV88E6XXX_FLAGS_FAMILY_6097,
3705
		.ops = &mv88e6085_ops,
3706 3707 3708 3709 3710 3711 3712 3713
	},

	[MV88E6095] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6095,
		.family = MV88E6XXX_FAMILY_6095,
		.name = "Marvell 88E6095/88E6095F",
		.num_databases = 256,
		.num_ports = 11,
3714
		.port_base_addr = 0x10,
3715
		.global1_addr = 0x1b,
3716
		.age_time_coeff = 15000,
3717
		.g1_irqs = 8,
3718
		.tag_protocol = DSA_TAG_PROTO_DSA,
3719
		.flags = MV88E6XXX_FLAGS_FAMILY_6095,
3720
		.ops = &mv88e6095_ops,
3721 3722
	},

3723 3724 3725 3726 3727 3728 3729 3730 3731
	[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,
3732
		.g1_irqs = 8,
3733
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3734 3735 3736 3737
		.flags = MV88E6XXX_FLAGS_FAMILY_6097,
		.ops = &mv88e6097_ops,
	},

3738 3739 3740 3741 3742 3743
	[MV88E6123] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6123,
		.family = MV88E6XXX_FAMILY_6165,
		.name = "Marvell 88E6123",
		.num_databases = 4096,
		.num_ports = 3,
3744
		.port_base_addr = 0x10,
3745
		.global1_addr = 0x1b,
3746
		.age_time_coeff = 15000,
3747
		.g1_irqs = 9,
3748
		.tag_protocol = DSA_TAG_PROTO_DSA,
3749
		.flags = MV88E6XXX_FLAGS_FAMILY_6165,
3750
		.ops = &mv88e6123_ops,
3751 3752 3753 3754 3755 3756 3757 3758
	},

	[MV88E6131] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6131,
		.family = MV88E6XXX_FAMILY_6185,
		.name = "Marvell 88E6131",
		.num_databases = 256,
		.num_ports = 8,
3759
		.port_base_addr = 0x10,
3760
		.global1_addr = 0x1b,
3761
		.age_time_coeff = 15000,
3762
		.g1_irqs = 9,
3763
		.tag_protocol = DSA_TAG_PROTO_DSA,
3764
		.flags = MV88E6XXX_FLAGS_FAMILY_6185,
3765
		.ops = &mv88e6131_ops,
3766 3767 3768 3769 3770 3771 3772 3773
	},

	[MV88E6161] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6161,
		.family = MV88E6XXX_FAMILY_6165,
		.name = "Marvell 88E6161",
		.num_databases = 4096,
		.num_ports = 6,
3774
		.port_base_addr = 0x10,
3775
		.global1_addr = 0x1b,
3776
		.age_time_coeff = 15000,
3777
		.g1_irqs = 9,
3778
		.tag_protocol = DSA_TAG_PROTO_DSA,
3779
		.flags = MV88E6XXX_FLAGS_FAMILY_6165,
3780
		.ops = &mv88e6161_ops,
3781 3782 3783 3784 3785 3786 3787 3788
	},

	[MV88E6165] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6165,
		.family = MV88E6XXX_FAMILY_6165,
		.name = "Marvell 88E6165",
		.num_databases = 4096,
		.num_ports = 6,
3789
		.port_base_addr = 0x10,
3790
		.global1_addr = 0x1b,
3791
		.age_time_coeff = 15000,
3792
		.g1_irqs = 9,
3793
		.tag_protocol = DSA_TAG_PROTO_DSA,
3794
		.flags = MV88E6XXX_FLAGS_FAMILY_6165,
3795
		.ops = &mv88e6165_ops,
3796 3797 3798 3799 3800 3801 3802 3803
	},

	[MV88E6171] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6171,
		.family = MV88E6XXX_FAMILY_6351,
		.name = "Marvell 88E6171",
		.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
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3809
		.flags = MV88E6XXX_FLAGS_FAMILY_6351,
3810
		.ops = &mv88e6171_ops,
3811 3812 3813 3814 3815 3816 3817 3818
	},

	[MV88E6172] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6172,
		.family = MV88E6XXX_FAMILY_6352,
		.name = "Marvell 88E6172",
		.num_databases = 4096,
		.num_ports = 7,
3819
		.port_base_addr = 0x10,
3820
		.global1_addr = 0x1b,
3821
		.age_time_coeff = 15000,
3822
		.g1_irqs = 9,
3823
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3824
		.flags = MV88E6XXX_FLAGS_FAMILY_6352,
3825
		.ops = &mv88e6172_ops,
3826 3827 3828 3829 3830 3831 3832 3833
	},

	[MV88E6175] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6175,
		.family = MV88E6XXX_FAMILY_6351,
		.name = "Marvell 88E6175",
		.num_databases = 4096,
		.num_ports = 7,
3834
		.port_base_addr = 0x10,
3835
		.global1_addr = 0x1b,
3836
		.age_time_coeff = 15000,
3837
		.g1_irqs = 9,
3838
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3839
		.flags = MV88E6XXX_FLAGS_FAMILY_6351,
3840
		.ops = &mv88e6175_ops,
3841 3842 3843 3844 3845 3846 3847 3848
	},

	[MV88E6176] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6176,
		.family = MV88E6XXX_FAMILY_6352,
		.name = "Marvell 88E6176",
		.num_databases = 4096,
		.num_ports = 7,
3849
		.port_base_addr = 0x10,
3850
		.global1_addr = 0x1b,
3851
		.age_time_coeff = 15000,
3852
		.g1_irqs = 9,
3853
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3854
		.flags = MV88E6XXX_FLAGS_FAMILY_6352,
3855
		.ops = &mv88e6176_ops,
3856 3857 3858 3859 3860 3861 3862 3863
	},

	[MV88E6185] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6185,
		.family = MV88E6XXX_FAMILY_6185,
		.name = "Marvell 88E6185",
		.num_databases = 256,
		.num_ports = 10,
3864
		.port_base_addr = 0x10,
3865
		.global1_addr = 0x1b,
3866
		.age_time_coeff = 15000,
3867
		.g1_irqs = 8,
3868
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3869
		.flags = MV88E6XXX_FLAGS_FAMILY_6185,
3870
		.ops = &mv88e6185_ops,
3871 3872
	},

3873 3874 3875 3876 3877 3878 3879 3880
	[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,
3881
		.tag_protocol = DSA_TAG_PROTO_DSA,
3882
		.age_time_coeff = 3750,
3883 3884 3885 3886 3887 3888 3889 3890 3891 3892 3893 3894 3895
		.g1_irqs = 9,
		.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,
3896
		.age_time_coeff = 3750,
3897
		.g1_irqs = 9,
3898
		.tag_protocol = DSA_TAG_PROTO_DSA,
3899 3900 3901 3902 3903 3904 3905 3906 3907 3908 3909 3910
		.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,
3911
		.age_time_coeff = 3750,
3912 3913
		.g1_irqs = 9,
		.tag_protocol = DSA_TAG_PROTO_DSA,
3914 3915 3916 3917
		.flags = MV88E6XXX_FLAGS_FAMILY_6390,
		.ops = &mv88e6391_ops,
	},

3918 3919 3920 3921 3922 3923
	[MV88E6240] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6240,
		.family = MV88E6XXX_FAMILY_6352,
		.name = "Marvell 88E6240",
		.num_databases = 4096,
		.num_ports = 7,
3924
		.port_base_addr = 0x10,
3925
		.global1_addr = 0x1b,
3926
		.age_time_coeff = 15000,
3927
		.g1_irqs = 9,
3928
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3929
		.flags = MV88E6XXX_FLAGS_FAMILY_6352,
3930
		.ops = &mv88e6240_ops,
3931 3932
	},

3933 3934 3935 3936 3937 3938 3939 3940
	[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,
3941
		.age_time_coeff = 3750,
3942
		.g1_irqs = 9,
3943
		.tag_protocol = DSA_TAG_PROTO_DSA,
3944 3945 3946 3947
		.flags = MV88E6XXX_FLAGS_FAMILY_6390,
		.ops = &mv88e6290_ops,
	},

3948 3949 3950 3951 3952 3953
	[MV88E6320] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6320,
		.family = MV88E6XXX_FAMILY_6320,
		.name = "Marvell 88E6320",
		.num_databases = 4096,
		.num_ports = 7,
3954
		.port_base_addr = 0x10,
3955
		.global1_addr = 0x1b,
3956
		.age_time_coeff = 15000,
3957
		.g1_irqs = 8,
3958
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3959
		.flags = MV88E6XXX_FLAGS_FAMILY_6320,
3960
		.ops = &mv88e6320_ops,
3961 3962 3963 3964 3965 3966 3967 3968
	},

	[MV88E6321] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6321,
		.family = MV88E6XXX_FAMILY_6320,
		.name = "Marvell 88E6321",
		.num_databases = 4096,
		.num_ports = 7,
3969
		.port_base_addr = 0x10,
3970
		.global1_addr = 0x1b,
3971
		.age_time_coeff = 15000,
3972
		.g1_irqs = 8,
3973
		.tag_protocol = DSA_TAG_PROTO_EDSA,
3974
		.flags = MV88E6XXX_FLAGS_FAMILY_6320,
3975
		.ops = &mv88e6321_ops,
3976 3977
	},

3978 3979 3980 3981 3982 3983 3984 3985 3986 3987 3988 3989 3990 3991
	[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,
		.tag_protocol = DSA_TAG_PROTO_EDSA,
		.flags = MV88E6XXX_FLAGS_FAMILY_6341,
		.ops = &mv88e6141_ops,
	},

3992 3993 3994 3995 3996 3997 3998 3999 4000 4001 4002 4003 4004 4005
	[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,
		.tag_protocol = DSA_TAG_PROTO_EDSA,
		.flags = MV88E6XXX_FLAGS_FAMILY_6341,
		.ops = &mv88e6341_ops,
	},

4006 4007 4008 4009 4010 4011
	[MV88E6350] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6350,
		.family = MV88E6XXX_FAMILY_6351,
		.name = "Marvell 88E6350",
		.num_databases = 4096,
		.num_ports = 7,
4012
		.port_base_addr = 0x10,
4013
		.global1_addr = 0x1b,
4014
		.age_time_coeff = 15000,
4015
		.g1_irqs = 9,
4016
		.tag_protocol = DSA_TAG_PROTO_EDSA,
4017
		.flags = MV88E6XXX_FLAGS_FAMILY_6351,
4018
		.ops = &mv88e6350_ops,
4019 4020 4021 4022 4023 4024 4025 4026
	},

	[MV88E6351] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6351,
		.family = MV88E6XXX_FAMILY_6351,
		.name = "Marvell 88E6351",
		.num_databases = 4096,
		.num_ports = 7,
4027
		.port_base_addr = 0x10,
4028
		.global1_addr = 0x1b,
4029
		.age_time_coeff = 15000,
4030
		.g1_irqs = 9,
4031
		.tag_protocol = DSA_TAG_PROTO_EDSA,
4032
		.flags = MV88E6XXX_FLAGS_FAMILY_6351,
4033
		.ops = &mv88e6351_ops,
4034 4035 4036 4037 4038 4039 4040 4041
	},

	[MV88E6352] = {
		.prod_num = PORT_SWITCH_ID_PROD_NUM_6352,
		.family = MV88E6XXX_FAMILY_6352,
		.name = "Marvell 88E6352",
		.num_databases = 4096,
		.num_ports = 7,
4042
		.port_base_addr = 0x10,
4043
		.global1_addr = 0x1b,
4044
		.age_time_coeff = 15000,
4045
		.g1_irqs = 9,
4046
		.tag_protocol = DSA_TAG_PROTO_EDSA,
4047
		.flags = MV88E6XXX_FLAGS_FAMILY_6352,
4048
		.ops = &mv88e6352_ops,
4049
	},
4050 4051 4052 4053 4054 4055 4056 4057
	[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,
4058
		.age_time_coeff = 3750,
4059
		.g1_irqs = 9,
4060
		.tag_protocol = DSA_TAG_PROTO_DSA,
4061 4062 4063 4064 4065 4066 4067 4068 4069 4070 4071
		.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,
4072
		.age_time_coeff = 3750,
4073
		.g1_irqs = 9,
4074
		.tag_protocol = DSA_TAG_PROTO_DSA,
4075 4076 4077
		.flags = MV88E6XXX_FLAGS_FAMILY_6390,
		.ops = &mv88e6390x_ops,
	},
4078 4079
};

4080
static const struct mv88e6xxx_info *mv88e6xxx_lookup_info(unsigned int prod_num)
4081
{
4082
	int i;
4083

4084 4085 4086
	for (i = 0; i < ARRAY_SIZE(mv88e6xxx_table); ++i)
		if (mv88e6xxx_table[i].prod_num == prod_num)
			return &mv88e6xxx_table[i];
4087 4088 4089 4090

	return NULL;
}

4091
static int mv88e6xxx_detect(struct mv88e6xxx_chip *chip)
4092 4093
{
	const struct mv88e6xxx_info *info;
4094 4095 4096
	unsigned int prod_num, rev;
	u16 id;
	int err;
4097

4098 4099 4100 4101 4102
	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_port_read(chip, 0, PORT_SWITCH_ID, &id);
	mutex_unlock(&chip->reg_lock);
	if (err)
		return err;
4103 4104 4105 4106 4107 4108 4109 4110

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

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

4111
	/* Update the compatible info with the probed one */
4112
	chip->info = info;
4113

4114 4115 4116 4117
	err = mv88e6xxx_g2_require(chip);
	if (err)
		return err;

4118 4119
	dev_info(chip->dev, "switch 0x%x detected: %s, revision %u\n",
		 chip->info->prod_num, chip->info->name, rev);
4120 4121 4122 4123

	return 0;
}

4124
static struct mv88e6xxx_chip *mv88e6xxx_alloc_chip(struct device *dev)
4125
{
4126
	struct mv88e6xxx_chip *chip;
4127

4128 4129
	chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL);
	if (!chip)
4130 4131
		return NULL;

4132
	chip->dev = dev;
4133

4134
	mutex_init(&chip->reg_lock);
4135
	INIT_LIST_HEAD(&chip->mdios);
4136

4137
	return chip;
4138 4139
}

4140 4141
static void mv88e6xxx_phy_init(struct mv88e6xxx_chip *chip)
{
4142
	if (chip->info->ops->ppu_enable && chip->info->ops->ppu_disable)
4143 4144 4145
		mv88e6xxx_ppu_state_init(chip);
}

4146 4147
static void mv88e6xxx_phy_destroy(struct mv88e6xxx_chip *chip)
{
4148
	if (chip->info->ops->ppu_enable && chip->info->ops->ppu_disable)
4149 4150 4151
		mv88e6xxx_ppu_state_destroy(chip);
}

4152
static int mv88e6xxx_smi_init(struct mv88e6xxx_chip *chip,
4153 4154
			      struct mii_bus *bus, int sw_addr)
{
4155
	if (sw_addr == 0)
4156
		chip->smi_ops = &mv88e6xxx_smi_single_chip_ops;
4157
	else if (mv88e6xxx_has(chip, MV88E6XXX_FLAGS_MULTI_CHIP))
4158
		chip->smi_ops = &mv88e6xxx_smi_multi_chip_ops;
4159 4160 4161
	else
		return -EINVAL;

4162 4163
	chip->bus = bus;
	chip->sw_addr = sw_addr;
4164 4165 4166 4167

	return 0;
}

4168 4169
static enum dsa_tag_protocol mv88e6xxx_get_tag_protocol(struct dsa_switch *ds)
{
V
Vivien Didelot 已提交
4170
	struct mv88e6xxx_chip *chip = ds->priv;
4171

4172
	return chip->info->tag_protocol;
4173 4174
}

4175 4176 4177
static const char *mv88e6xxx_drv_probe(struct device *dsa_dev,
				       struct device *host_dev, int sw_addr,
				       void **priv)
4178
{
4179
	struct mv88e6xxx_chip *chip;
4180
	struct mii_bus *bus;
4181
	int err;
4182

4183
	bus = dsa_host_dev_to_mii_bus(host_dev);
4184 4185 4186
	if (!bus)
		return NULL;

4187 4188
	chip = mv88e6xxx_alloc_chip(dsa_dev);
	if (!chip)
4189 4190
		return NULL;

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

4194
	err = mv88e6xxx_smi_init(chip, bus, sw_addr);
4195 4196 4197
	if (err)
		goto free;

4198
	err = mv88e6xxx_detect(chip);
4199
	if (err)
4200
		goto free;
4201

4202 4203 4204 4205 4206 4207
	mutex_lock(&chip->reg_lock);
	err = mv88e6xxx_switch_reset(chip);
	mutex_unlock(&chip->reg_lock);
	if (err)
		goto free;

4208 4209
	mv88e6xxx_phy_init(chip);

4210
	err = mv88e6xxx_mdios_register(chip, NULL);
4211
	if (err)
4212
		goto free;
4213

4214
	*priv = chip;
4215

4216
	return chip->info->name;
4217
free:
4218
	devm_kfree(dsa_dev, chip);
4219 4220

	return NULL;
4221 4222
}

4223 4224 4225 4226 4227 4228 4229 4230 4231 4232 4233 4234 4235 4236 4237
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 已提交
4238
	struct mv88e6xxx_chip *chip = ds->priv;
4239 4240 4241 4242 4243 4244 4245 4246 4247 4248 4249

	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 已提交
4250
	struct mv88e6xxx_chip *chip = ds->priv;
4251 4252 4253 4254 4255 4256 4257 4258 4259 4260 4261 4262 4263 4264
	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 已提交
4265
	struct mv88e6xxx_chip *chip = ds->priv;
4266 4267 4268 4269 4270 4271 4272 4273 4274
	int err;

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

	return err;
}

4275
static const struct dsa_switch_ops mv88e6xxx_switch_ops = {
4276
	.probe			= mv88e6xxx_drv_probe,
4277
	.get_tag_protocol	= mv88e6xxx_get_tag_protocol,
4278 4279 4280 4281 4282 4283 4284 4285
	.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,
4286
	.get_eeprom_len		= mv88e6xxx_get_eeprom_len,
4287 4288 4289 4290
	.get_eeprom		= mv88e6xxx_get_eeprom,
	.set_eeprom		= mv88e6xxx_set_eeprom,
	.get_regs_len		= mv88e6xxx_get_regs_len,
	.get_regs		= mv88e6xxx_get_regs,
4291
	.set_ageing_time	= mv88e6xxx_set_ageing_time,
4292 4293 4294
	.port_bridge_join	= mv88e6xxx_port_bridge_join,
	.port_bridge_leave	= mv88e6xxx_port_bridge_leave,
	.port_stp_state_set	= mv88e6xxx_port_stp_state_set,
4295
	.port_fast_age		= mv88e6xxx_port_fast_age,
4296 4297 4298 4299 4300 4301 4302 4303 4304
	.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,
4305 4306 4307 4308
	.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,
4309 4310
};

4311 4312 4313 4314
static struct dsa_switch_driver mv88e6xxx_switch_drv = {
	.ops			= &mv88e6xxx_switch_ops,
};

4315
static int mv88e6xxx_register_switch(struct mv88e6xxx_chip *chip)
4316
{
4317
	struct device *dev = chip->dev;
4318 4319
	struct dsa_switch *ds;

4320
	ds = dsa_switch_alloc(dev, DSA_MAX_PORTS);
4321 4322 4323
	if (!ds)
		return -ENOMEM;

4324
	ds->priv = chip;
4325
	ds->ops = &mv88e6xxx_switch_ops;
4326 4327 4328

	dev_set_drvdata(dev, ds);

4329
	return dsa_register_switch(ds, dev);
4330 4331
}

4332
static void mv88e6xxx_unregister_switch(struct mv88e6xxx_chip *chip)
4333
{
4334
	dsa_unregister_switch(chip->ds);
4335 4336
}

4337
static int mv88e6xxx_probe(struct mdio_device *mdiodev)
4338
{
4339
	struct device *dev = &mdiodev->dev;
4340
	struct device_node *np = dev->of_node;
4341
	const struct mv88e6xxx_info *compat_info;
4342
	struct mv88e6xxx_chip *chip;
4343
	u32 eeprom_len;
4344
	int err;
4345

4346 4347 4348 4349
	compat_info = of_device_get_match_data(dev);
	if (!compat_info)
		return -EINVAL;

4350 4351
	chip = mv88e6xxx_alloc_chip(dev);
	if (!chip)
4352 4353
		return -ENOMEM;

4354
	chip->info = compat_info;
4355

4356 4357 4358 4359
	err = mv88e6xxx_verify_madatory_ops(chip, chip->info->ops);
	if (err)
		return err;

4360
	err = mv88e6xxx_smi_init(chip, mdiodev->bus, mdiodev->addr);
4361 4362
	if (err)
		return err;
4363

4364 4365 4366 4367
	chip->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_LOW);
	if (IS_ERR(chip->reset))
		return PTR_ERR(chip->reset);

4368
	err = mv88e6xxx_detect(chip);
4369 4370
	if (err)
		return err;
4371

4372 4373
	mv88e6xxx_phy_init(chip);

4374
	if (chip->info->ops->get_eeprom &&
4375
	    !of_property_read_u32(np, "eeprom-length", &eeprom_len))
4376
		chip->eeprom_len = eeprom_len;
4377

4378 4379 4380 4381 4382 4383 4384 4385 4386 4387 4388 4389 4390 4391 4392 4393 4394 4395 4396 4397 4398 4399 4400 4401 4402 4403 4404 4405 4406 4407 4408
	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;
		}
	}

4409
	err = mv88e6xxx_mdios_register(chip, np);
4410
	if (err)
4411
		goto out_g2_irq;
4412

4413
	err = mv88e6xxx_register_switch(chip);
4414 4415
	if (err)
		goto out_mdio;
4416

4417
	return 0;
4418 4419

out_mdio:
4420
	mv88e6xxx_mdios_unregister(chip);
4421
out_g2_irq:
4422
	if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT) && chip->irq > 0)
4423 4424
		mv88e6xxx_g2_irq_free(chip);
out_g1_irq:
4425 4426
	if (chip->irq > 0) {
		mutex_lock(&chip->reg_lock);
4427
		mv88e6xxx_g1_irq_free(chip);
4428 4429
		mutex_unlock(&chip->reg_lock);
	}
4430 4431
out:
	return err;
4432
}
4433 4434 4435 4436

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

4439
	mv88e6xxx_phy_destroy(chip);
4440
	mv88e6xxx_unregister_switch(chip);
4441
	mv88e6xxx_mdios_unregister(chip);
4442

4443 4444 4445 4446 4447
	if (chip->irq > 0) {
		if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT))
			mv88e6xxx_g2_irq_free(chip);
		mv88e6xxx_g1_irq_free(chip);
	}
4448 4449 4450
}

static const struct of_device_id mv88e6xxx_of_match[] = {
4451 4452 4453 4454
	{
		.compatible = "marvell,mv88e6085",
		.data = &mv88e6xxx_table[MV88E6085],
	},
4455 4456 4457 4458
	{
		.compatible = "marvell,mv88e6190",
		.data = &mv88e6xxx_table[MV88E6190],
	},
4459 4460 4461 4462 4463 4464 4465 4466 4467 4468 4469 4470 4471 4472 4473 4474
	{ /* 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)
{
4475
	register_switch_driver(&mv88e6xxx_switch_drv);
4476 4477
	return mdio_driver_register(&mv88e6xxx_driver);
}
4478 4479 4480 4481
module_init(mv88e6xxx_init);

static void __exit mv88e6xxx_cleanup(void)
{
4482
	mdio_driver_unregister(&mv88e6xxx_driver);
4483
	unregister_switch_driver(&mv88e6xxx_switch_drv);
4484 4485
}
module_exit(mv88e6xxx_cleanup);
4486 4487 4488 4489

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