2 * Marvell 88e6xxx Ethernet switch single-chip support
4 * Copyright (c) 2008 Marvell Semiconductor
6 * Copyright (c) 2015 CMC Electronics, Inc.
7 * Added support for VLAN Table Unit operations
9 * Copyright (c) 2016 Andrew Lunn <andrew@lunn.ch>
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or
14 * (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 #include <linux/interrupt.h>
22 #include <linux/irq.h>
23 #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>
35 #include <net/switchdev.h>
37 #include "mv88e6xxx.h"
42 static void assert_reg_lock(struct mv88e6xxx_chip
*chip
)
44 if (unlikely(!mutex_is_locked(&chip
->reg_lock
))) {
45 dev_err(chip
->dev
, "Switch registers lock not held!\n");
50 /* The switch ADDR[4:1] configuration pins define the chip SMI device address
51 * (ADDR[0] is always zero, thus only even SMI addresses can be strapped).
53 * When ADDR is all zero, the chip uses Single-chip Addressing Mode, assuming it
54 * is the only device connected to the SMI master. In this mode it responds to
55 * all 32 possible SMI addresses, and thus maps directly the internal devices.
57 * When ADDR is non-zero, the chip uses Multi-chip Addressing Mode, allowing
58 * multiple devices to share the SMI interface. In this mode it responds to only
59 * 2 registers, used to indirectly access the internal SMI devices.
62 static int mv88e6xxx_smi_read(struct mv88e6xxx_chip
*chip
,
63 int addr
, int reg
, u16
*val
)
68 return chip
->smi_ops
->read(chip
, addr
, reg
, val
);
71 static int mv88e6xxx_smi_write(struct mv88e6xxx_chip
*chip
,
72 int addr
, int reg
, u16 val
)
77 return chip
->smi_ops
->write(chip
, addr
, reg
, val
);
80 static int mv88e6xxx_smi_single_chip_read(struct mv88e6xxx_chip
*chip
,
81 int addr
, int reg
, u16
*val
)
85 ret
= mdiobus_read_nested(chip
->bus
, addr
, reg
);
94 static int mv88e6xxx_smi_single_chip_write(struct mv88e6xxx_chip
*chip
,
95 int addr
, int reg
, u16 val
)
99 ret
= mdiobus_write_nested(chip
->bus
, addr
, reg
, val
);
106 static const struct mv88e6xxx_bus_ops mv88e6xxx_smi_single_chip_ops
= {
107 .read
= mv88e6xxx_smi_single_chip_read
,
108 .write
= mv88e6xxx_smi_single_chip_write
,
111 static int mv88e6xxx_smi_multi_chip_wait(struct mv88e6xxx_chip
*chip
)
116 for (i
= 0; i
< 16; i
++) {
117 ret
= mdiobus_read_nested(chip
->bus
, chip
->sw_addr
, SMI_CMD
);
121 if ((ret
& SMI_CMD_BUSY
) == 0)
128 static int mv88e6xxx_smi_multi_chip_read(struct mv88e6xxx_chip
*chip
,
129 int addr
, int reg
, u16
*val
)
133 /* Wait for the bus to become free. */
134 ret
= mv88e6xxx_smi_multi_chip_wait(chip
);
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
);
144 /* Wait for the read command to complete. */
145 ret
= mv88e6xxx_smi_multi_chip_wait(chip
);
150 ret
= mdiobus_read_nested(chip
->bus
, chip
->sw_addr
, SMI_DATA
);
159 static int mv88e6xxx_smi_multi_chip_write(struct mv88e6xxx_chip
*chip
,
160 int addr
, int reg
, u16 val
)
164 /* Wait for the bus to become free. */
165 ret
= mv88e6xxx_smi_multi_chip_wait(chip
);
169 /* Transmit the data to write. */
170 ret
= mdiobus_write_nested(chip
->bus
, chip
->sw_addr
, SMI_DATA
, val
);
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
);
180 /* Wait for the write command to complete. */
181 ret
= mv88e6xxx_smi_multi_chip_wait(chip
);
188 static const struct mv88e6xxx_bus_ops mv88e6xxx_smi_multi_chip_ops
= {
189 .read
= mv88e6xxx_smi_multi_chip_read
,
190 .write
= mv88e6xxx_smi_multi_chip_write
,
193 int mv88e6xxx_read(struct mv88e6xxx_chip
*chip
, int addr
, int reg
, u16
*val
)
197 assert_reg_lock(chip
);
199 err
= mv88e6xxx_smi_read(chip
, addr
, reg
, val
);
203 dev_dbg(chip
->dev
, "<- addr: 0x%.2x reg: 0x%.2x val: 0x%.4x\n",
209 int mv88e6xxx_write(struct mv88e6xxx_chip
*chip
, int addr
, int reg
, u16 val
)
213 assert_reg_lock(chip
);
215 err
= mv88e6xxx_smi_write(chip
, addr
, reg
, val
);
219 dev_dbg(chip
->dev
, "-> addr: 0x%.2x reg: 0x%.2x val: 0x%.4x\n",
225 static int mv88e6xxx_phy_read(struct mv88e6xxx_chip
*chip
, int phy
,
228 int addr
= phy
; /* PHY devices addresses start at 0x0 */
230 if (!chip
->info
->ops
->phy_read
)
233 return chip
->info
->ops
->phy_read(chip
, addr
, reg
, val
);
236 static int mv88e6xxx_phy_write(struct mv88e6xxx_chip
*chip
, int phy
,
239 int addr
= phy
; /* PHY devices addresses start at 0x0 */
241 if (!chip
->info
->ops
->phy_write
)
244 return chip
->info
->ops
->phy_write(chip
, addr
, reg
, val
);
247 static int mv88e6xxx_phy_page_get(struct mv88e6xxx_chip
*chip
, int phy
, u8 page
)
249 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_PHY_PAGE
))
252 return mv88e6xxx_phy_write(chip
, phy
, PHY_PAGE
, page
);
255 static void mv88e6xxx_phy_page_put(struct mv88e6xxx_chip
*chip
, int phy
)
259 /* Restore PHY page Copper 0x0 for access via the registered MDIO bus */
260 err
= mv88e6xxx_phy_write(chip
, phy
, PHY_PAGE
, PHY_PAGE_COPPER
);
262 dev_err(chip
->dev
, "failed to restore PHY %d page Copper (%d)\n",
267 static int mv88e6xxx_phy_page_read(struct mv88e6xxx_chip
*chip
, int phy
,
268 u8 page
, int reg
, u16
*val
)
272 /* There is no paging for registers 22 */
276 err
= mv88e6xxx_phy_page_get(chip
, phy
, page
);
278 err
= mv88e6xxx_phy_read(chip
, phy
, reg
, val
);
279 mv88e6xxx_phy_page_put(chip
, phy
);
285 static int mv88e6xxx_phy_page_write(struct mv88e6xxx_chip
*chip
, int phy
,
286 u8 page
, int reg
, u16 val
)
290 /* There is no paging for registers 22 */
294 err
= mv88e6xxx_phy_page_get(chip
, phy
, page
);
296 err
= mv88e6xxx_phy_write(chip
, phy
, PHY_PAGE
, page
);
297 mv88e6xxx_phy_page_put(chip
, phy
);
303 static int mv88e6xxx_serdes_read(struct mv88e6xxx_chip
*chip
, int reg
, u16
*val
)
305 return mv88e6xxx_phy_page_read(chip
, ADDR_SERDES
, SERDES_PAGE_FIBER
,
309 static int mv88e6xxx_serdes_write(struct mv88e6xxx_chip
*chip
, int reg
, u16 val
)
311 return mv88e6xxx_phy_page_write(chip
, ADDR_SERDES
, SERDES_PAGE_FIBER
,
315 static void mv88e6xxx_g1_irq_mask(struct irq_data
*d
)
317 struct mv88e6xxx_chip
*chip
= irq_data_get_irq_chip_data(d
);
318 unsigned int n
= d
->hwirq
;
320 chip
->g1_irq
.masked
|= (1 << n
);
323 static void mv88e6xxx_g1_irq_unmask(struct irq_data
*d
)
325 struct mv88e6xxx_chip
*chip
= irq_data_get_irq_chip_data(d
);
326 unsigned int n
= d
->hwirq
;
328 chip
->g1_irq
.masked
&= ~(1 << n
);
331 static irqreturn_t
mv88e6xxx_g1_irq_thread_fn(int irq
, void *dev_id
)
333 struct mv88e6xxx_chip
*chip
= dev_id
;
334 unsigned int nhandled
= 0;
335 unsigned int sub_irq
;
340 mutex_lock(&chip
->reg_lock
);
341 err
= mv88e6xxx_g1_read(chip
, GLOBAL_STATUS
, ®
);
342 mutex_unlock(&chip
->reg_lock
);
347 for (n
= 0; n
< chip
->g1_irq
.nirqs
; ++n
) {
348 if (reg
& (1 << n
)) {
349 sub_irq
= irq_find_mapping(chip
->g1_irq
.domain
, n
);
350 handle_nested_irq(sub_irq
);
355 return (nhandled
> 0 ? IRQ_HANDLED
: IRQ_NONE
);
358 static void mv88e6xxx_g1_irq_bus_lock(struct irq_data
*d
)
360 struct mv88e6xxx_chip
*chip
= irq_data_get_irq_chip_data(d
);
362 mutex_lock(&chip
->reg_lock
);
365 static void mv88e6xxx_g1_irq_bus_sync_unlock(struct irq_data
*d
)
367 struct mv88e6xxx_chip
*chip
= irq_data_get_irq_chip_data(d
);
368 u16 mask
= GENMASK(chip
->g1_irq
.nirqs
, 0);
372 err
= mv88e6xxx_g1_read(chip
, GLOBAL_CONTROL
, ®
);
377 reg
|= (~chip
->g1_irq
.masked
& mask
);
379 err
= mv88e6xxx_g1_write(chip
, GLOBAL_CONTROL
, reg
);
384 mutex_unlock(&chip
->reg_lock
);
387 static struct irq_chip mv88e6xxx_g1_irq_chip
= {
388 .name
= "mv88e6xxx-g1",
389 .irq_mask
= mv88e6xxx_g1_irq_mask
,
390 .irq_unmask
= mv88e6xxx_g1_irq_unmask
,
391 .irq_bus_lock
= mv88e6xxx_g1_irq_bus_lock
,
392 .irq_bus_sync_unlock
= mv88e6xxx_g1_irq_bus_sync_unlock
,
395 static int mv88e6xxx_g1_irq_domain_map(struct irq_domain
*d
,
397 irq_hw_number_t hwirq
)
399 struct mv88e6xxx_chip
*chip
= d
->host_data
;
401 irq_set_chip_data(irq
, d
->host_data
);
402 irq_set_chip_and_handler(irq
, &chip
->g1_irq
.chip
, handle_level_irq
);
403 irq_set_noprobe(irq
);
408 static const struct irq_domain_ops mv88e6xxx_g1_irq_domain_ops
= {
409 .map
= mv88e6xxx_g1_irq_domain_map
,
410 .xlate
= irq_domain_xlate_twocell
,
413 static void mv88e6xxx_g1_irq_free(struct mv88e6xxx_chip
*chip
)
418 mv88e6xxx_g1_read(chip
, GLOBAL_CONTROL
, &mask
);
419 mask
|= GENMASK(chip
->g1_irq
.nirqs
, 0);
420 mv88e6xxx_g1_write(chip
, GLOBAL_CONTROL
, mask
);
422 free_irq(chip
->irq
, chip
);
424 for (irq
= 0; irq
< chip
->g1_irq
.nirqs
; irq
++) {
425 virq
= irq_find_mapping(chip
->g1_irq
.domain
, irq
);
426 irq_dispose_mapping(virq
);
429 irq_domain_remove(chip
->g1_irq
.domain
);
432 static int mv88e6xxx_g1_irq_setup(struct mv88e6xxx_chip
*chip
)
437 chip
->g1_irq
.nirqs
= chip
->info
->g1_irqs
;
438 chip
->g1_irq
.domain
= irq_domain_add_simple(
439 NULL
, chip
->g1_irq
.nirqs
, 0,
440 &mv88e6xxx_g1_irq_domain_ops
, chip
);
441 if (!chip
->g1_irq
.domain
)
444 for (irq
= 0; irq
< chip
->g1_irq
.nirqs
; irq
++)
445 irq_create_mapping(chip
->g1_irq
.domain
, irq
);
447 chip
->g1_irq
.chip
= mv88e6xxx_g1_irq_chip
;
448 chip
->g1_irq
.masked
= ~0;
450 err
= mv88e6xxx_g1_read(chip
, GLOBAL_CONTROL
, &mask
);
454 mask
&= ~GENMASK(chip
->g1_irq
.nirqs
, 0);
456 err
= mv88e6xxx_g1_write(chip
, GLOBAL_CONTROL
, mask
);
460 /* Reading the interrupt status clears (most of) them */
461 err
= mv88e6xxx_g1_read(chip
, GLOBAL_STATUS
, ®
);
465 err
= request_threaded_irq(chip
->irq
, NULL
,
466 mv88e6xxx_g1_irq_thread_fn
,
467 IRQF_ONESHOT
| IRQF_TRIGGER_FALLING
,
468 dev_name(chip
->dev
), chip
);
475 mask
|= GENMASK(chip
->g1_irq
.nirqs
, 0);
476 mv88e6xxx_g1_write(chip
, GLOBAL_CONTROL
, mask
);
479 for (irq
= 0; irq
< 16; irq
++) {
480 virq
= irq_find_mapping(chip
->g1_irq
.domain
, irq
);
481 irq_dispose_mapping(virq
);
484 irq_domain_remove(chip
->g1_irq
.domain
);
489 int mv88e6xxx_wait(struct mv88e6xxx_chip
*chip
, int addr
, int reg
, u16 mask
)
493 for (i
= 0; i
< 16; i
++) {
497 err
= mv88e6xxx_read(chip
, addr
, reg
, &val
);
504 usleep_range(1000, 2000);
507 dev_err(chip
->dev
, "Timeout while waiting for switch\n");
511 /* Indirect write to single pointer-data register with an Update bit */
512 int mv88e6xxx_update(struct mv88e6xxx_chip
*chip
, int addr
, int reg
, u16 update
)
517 /* Wait until the previous operation is completed */
518 err
= mv88e6xxx_wait(chip
, addr
, reg
, BIT(15));
522 /* Set the Update bit to trigger a write operation */
523 val
= BIT(15) | update
;
525 return mv88e6xxx_write(chip
, addr
, reg
, val
);
528 static int mv88e6xxx_ppu_disable(struct mv88e6xxx_chip
*chip
)
530 if (!chip
->info
->ops
->ppu_disable
)
533 return chip
->info
->ops
->ppu_disable(chip
);
536 static int mv88e6xxx_ppu_enable(struct mv88e6xxx_chip
*chip
)
538 if (!chip
->info
->ops
->ppu_enable
)
541 return chip
->info
->ops
->ppu_enable(chip
);
544 static void mv88e6xxx_ppu_reenable_work(struct work_struct
*ugly
)
546 struct mv88e6xxx_chip
*chip
;
548 chip
= container_of(ugly
, struct mv88e6xxx_chip
, ppu_work
);
550 mutex_lock(&chip
->reg_lock
);
552 if (mutex_trylock(&chip
->ppu_mutex
)) {
553 if (mv88e6xxx_ppu_enable(chip
) == 0)
554 chip
->ppu_disabled
= 0;
555 mutex_unlock(&chip
->ppu_mutex
);
558 mutex_unlock(&chip
->reg_lock
);
561 static void mv88e6xxx_ppu_reenable_timer(unsigned long _ps
)
563 struct mv88e6xxx_chip
*chip
= (void *)_ps
;
565 schedule_work(&chip
->ppu_work
);
568 static int mv88e6xxx_ppu_access_get(struct mv88e6xxx_chip
*chip
)
572 mutex_lock(&chip
->ppu_mutex
);
574 /* If the PHY polling unit is enabled, disable it so that
575 * we can access the PHY registers. If it was already
576 * disabled, cancel the timer that is going to re-enable
579 if (!chip
->ppu_disabled
) {
580 ret
= mv88e6xxx_ppu_disable(chip
);
582 mutex_unlock(&chip
->ppu_mutex
);
585 chip
->ppu_disabled
= 1;
587 del_timer(&chip
->ppu_timer
);
594 static void mv88e6xxx_ppu_access_put(struct mv88e6xxx_chip
*chip
)
596 /* Schedule a timer to re-enable the PHY polling unit. */
597 mod_timer(&chip
->ppu_timer
, jiffies
+ msecs_to_jiffies(10));
598 mutex_unlock(&chip
->ppu_mutex
);
601 static void mv88e6xxx_ppu_state_init(struct mv88e6xxx_chip
*chip
)
603 mutex_init(&chip
->ppu_mutex
);
604 INIT_WORK(&chip
->ppu_work
, mv88e6xxx_ppu_reenable_work
);
605 setup_timer(&chip
->ppu_timer
, mv88e6xxx_ppu_reenable_timer
,
606 (unsigned long)chip
);
609 static void mv88e6xxx_ppu_state_destroy(struct mv88e6xxx_chip
*chip
)
611 del_timer_sync(&chip
->ppu_timer
);
614 static int mv88e6xxx_phy_ppu_read(struct mv88e6xxx_chip
*chip
, int addr
,
619 err
= mv88e6xxx_ppu_access_get(chip
);
621 err
= mv88e6xxx_read(chip
, addr
, reg
, val
);
622 mv88e6xxx_ppu_access_put(chip
);
628 static int mv88e6xxx_phy_ppu_write(struct mv88e6xxx_chip
*chip
, int addr
,
633 err
= mv88e6xxx_ppu_access_get(chip
);
635 err
= mv88e6xxx_write(chip
, addr
, reg
, val
);
636 mv88e6xxx_ppu_access_put(chip
);
642 static bool mv88e6xxx_6095_family(struct mv88e6xxx_chip
*chip
)
644 return chip
->info
->family
== MV88E6XXX_FAMILY_6095
;
647 static bool mv88e6xxx_6097_family(struct mv88e6xxx_chip
*chip
)
649 return chip
->info
->family
== MV88E6XXX_FAMILY_6097
;
652 static bool mv88e6xxx_6165_family(struct mv88e6xxx_chip
*chip
)
654 return chip
->info
->family
== MV88E6XXX_FAMILY_6165
;
657 static bool mv88e6xxx_6185_family(struct mv88e6xxx_chip
*chip
)
659 return chip
->info
->family
== MV88E6XXX_FAMILY_6185
;
662 static bool mv88e6xxx_6320_family(struct mv88e6xxx_chip
*chip
)
664 return chip
->info
->family
== MV88E6XXX_FAMILY_6320
;
667 static bool mv88e6xxx_6351_family(struct mv88e6xxx_chip
*chip
)
669 return chip
->info
->family
== MV88E6XXX_FAMILY_6351
;
672 static bool mv88e6xxx_6352_family(struct mv88e6xxx_chip
*chip
)
674 return chip
->info
->family
== MV88E6XXX_FAMILY_6352
;
677 static int mv88e6xxx_port_setup_mac(struct mv88e6xxx_chip
*chip
, int port
,
678 int link
, int speed
, int duplex
,
679 phy_interface_t mode
)
683 if (!chip
->info
->ops
->port_set_link
)
686 /* Port's MAC control must not be changed unless the link is down */
687 err
= chip
->info
->ops
->port_set_link(chip
, port
, 0);
691 if (chip
->info
->ops
->port_set_speed
) {
692 err
= chip
->info
->ops
->port_set_speed(chip
, port
, speed
);
693 if (err
&& err
!= -EOPNOTSUPP
)
697 if (chip
->info
->ops
->port_set_duplex
) {
698 err
= chip
->info
->ops
->port_set_duplex(chip
, port
, duplex
);
699 if (err
&& err
!= -EOPNOTSUPP
)
703 if (chip
->info
->ops
->port_set_rgmii_delay
) {
704 err
= chip
->info
->ops
->port_set_rgmii_delay(chip
, port
, mode
);
705 if (err
&& err
!= -EOPNOTSUPP
)
711 if (chip
->info
->ops
->port_set_link(chip
, port
, link
))
712 netdev_err(chip
->ds
->ports
[port
].netdev
,
713 "failed to restore MAC's link\n");
718 /* We expect the switch to perform auto negotiation if there is a real
719 * phy. However, in the case of a fixed link phy, we force the port
720 * settings from the fixed link settings.
722 static void mv88e6xxx_adjust_link(struct dsa_switch
*ds
, int port
,
723 struct phy_device
*phydev
)
725 struct mv88e6xxx_chip
*chip
= ds
->priv
;
728 if (!phy_is_pseudo_fixed_link(phydev
))
731 mutex_lock(&chip
->reg_lock
);
732 err
= mv88e6xxx_port_setup_mac(chip
, port
, phydev
->link
, phydev
->speed
,
733 phydev
->duplex
, phydev
->interface
);
734 mutex_unlock(&chip
->reg_lock
);
736 if (err
&& err
!= -EOPNOTSUPP
)
737 netdev_err(ds
->ports
[port
].netdev
, "failed to configure MAC\n");
740 static int mv88e6xxx_stats_snapshot(struct mv88e6xxx_chip
*chip
, int port
)
742 if (!chip
->info
->ops
->stats_snapshot
)
745 return chip
->info
->ops
->stats_snapshot(chip
, port
);
748 static struct mv88e6xxx_hw_stat mv88e6xxx_hw_stats
[] = {
749 { "in_good_octets", 8, 0x00, STATS_TYPE_BANK0
, },
750 { "in_bad_octets", 4, 0x02, STATS_TYPE_BANK0
, },
751 { "in_unicast", 4, 0x04, STATS_TYPE_BANK0
, },
752 { "in_broadcasts", 4, 0x06, STATS_TYPE_BANK0
, },
753 { "in_multicasts", 4, 0x07, STATS_TYPE_BANK0
, },
754 { "in_pause", 4, 0x16, STATS_TYPE_BANK0
, },
755 { "in_undersize", 4, 0x18, STATS_TYPE_BANK0
, },
756 { "in_fragments", 4, 0x19, STATS_TYPE_BANK0
, },
757 { "in_oversize", 4, 0x1a, STATS_TYPE_BANK0
, },
758 { "in_jabber", 4, 0x1b, STATS_TYPE_BANK0
, },
759 { "in_rx_error", 4, 0x1c, STATS_TYPE_BANK0
, },
760 { "in_fcs_error", 4, 0x1d, STATS_TYPE_BANK0
, },
761 { "out_octets", 8, 0x0e, STATS_TYPE_BANK0
, },
762 { "out_unicast", 4, 0x10, STATS_TYPE_BANK0
, },
763 { "out_broadcasts", 4, 0x13, STATS_TYPE_BANK0
, },
764 { "out_multicasts", 4, 0x12, STATS_TYPE_BANK0
, },
765 { "out_pause", 4, 0x15, STATS_TYPE_BANK0
, },
766 { "excessive", 4, 0x11, STATS_TYPE_BANK0
, },
767 { "collisions", 4, 0x1e, STATS_TYPE_BANK0
, },
768 { "deferred", 4, 0x05, STATS_TYPE_BANK0
, },
769 { "single", 4, 0x14, STATS_TYPE_BANK0
, },
770 { "multiple", 4, 0x17, STATS_TYPE_BANK0
, },
771 { "out_fcs_error", 4, 0x03, STATS_TYPE_BANK0
, },
772 { "late", 4, 0x1f, STATS_TYPE_BANK0
, },
773 { "hist_64bytes", 4, 0x08, STATS_TYPE_BANK0
, },
774 { "hist_65_127bytes", 4, 0x09, STATS_TYPE_BANK0
, },
775 { "hist_128_255bytes", 4, 0x0a, STATS_TYPE_BANK0
, },
776 { "hist_256_511bytes", 4, 0x0b, STATS_TYPE_BANK0
, },
777 { "hist_512_1023bytes", 4, 0x0c, STATS_TYPE_BANK0
, },
778 { "hist_1024_max_bytes", 4, 0x0d, STATS_TYPE_BANK0
, },
779 { "sw_in_discards", 4, 0x10, STATS_TYPE_PORT
, },
780 { "sw_in_filtered", 2, 0x12, STATS_TYPE_PORT
, },
781 { "sw_out_filtered", 2, 0x13, STATS_TYPE_PORT
, },
782 { "in_discards", 4, 0x00, STATS_TYPE_BANK1
, },
783 { "in_filtered", 4, 0x01, STATS_TYPE_BANK1
, },
784 { "in_accepted", 4, 0x02, STATS_TYPE_BANK1
, },
785 { "in_bad_accepted", 4, 0x03, STATS_TYPE_BANK1
, },
786 { "in_good_avb_class_a", 4, 0x04, STATS_TYPE_BANK1
, },
787 { "in_good_avb_class_b", 4, 0x05, STATS_TYPE_BANK1
, },
788 { "in_bad_avb_class_a", 4, 0x06, STATS_TYPE_BANK1
, },
789 { "in_bad_avb_class_b", 4, 0x07, STATS_TYPE_BANK1
, },
790 { "tcam_counter_0", 4, 0x08, STATS_TYPE_BANK1
, },
791 { "tcam_counter_1", 4, 0x09, STATS_TYPE_BANK1
, },
792 { "tcam_counter_2", 4, 0x0a, STATS_TYPE_BANK1
, },
793 { "tcam_counter_3", 4, 0x0b, STATS_TYPE_BANK1
, },
794 { "in_da_unknown", 4, 0x0e, STATS_TYPE_BANK1
, },
795 { "in_management", 4, 0x0f, STATS_TYPE_BANK1
, },
796 { "out_queue_0", 4, 0x10, STATS_TYPE_BANK1
, },
797 { "out_queue_1", 4, 0x11, STATS_TYPE_BANK1
, },
798 { "out_queue_2", 4, 0x12, STATS_TYPE_BANK1
, },
799 { "out_queue_3", 4, 0x13, STATS_TYPE_BANK1
, },
800 { "out_queue_4", 4, 0x14, STATS_TYPE_BANK1
, },
801 { "out_queue_5", 4, 0x15, STATS_TYPE_BANK1
, },
802 { "out_queue_6", 4, 0x16, STATS_TYPE_BANK1
, },
803 { "out_queue_7", 4, 0x17, STATS_TYPE_BANK1
, },
804 { "out_cut_through", 4, 0x18, STATS_TYPE_BANK1
, },
805 { "out_octets_a", 4, 0x1a, STATS_TYPE_BANK1
, },
806 { "out_octets_b", 4, 0x1b, STATS_TYPE_BANK1
, },
807 { "out_management", 4, 0x1f, STATS_TYPE_BANK1
, },
810 static uint64_t _mv88e6xxx_get_ethtool_stat(struct mv88e6xxx_chip
*chip
,
811 struct mv88e6xxx_hw_stat
*s
,
812 int port
, u16 bank1_select
,
822 case STATS_TYPE_PORT
:
823 err
= mv88e6xxx_port_read(chip
, port
, s
->reg
, ®
);
828 if (s
->sizeof_stat
== 4) {
829 err
= mv88e6xxx_port_read(chip
, port
, s
->reg
+ 1, ®
);
835 case STATS_TYPE_BANK1
:
838 case STATS_TYPE_BANK0
:
839 reg
|= s
->reg
| histogram
;
840 mv88e6xxx_g1_stats_read(chip
, reg
, &low
);
841 if (s
->sizeof_stat
== 8)
842 mv88e6xxx_g1_stats_read(chip
, reg
+ 1, &high
);
844 value
= (((u64
)high
) << 16) | low
;
848 static void mv88e6xxx_stats_get_strings(struct mv88e6xxx_chip
*chip
,
849 uint8_t *data
, int types
)
851 struct mv88e6xxx_hw_stat
*stat
;
854 for (i
= 0, j
= 0; i
< ARRAY_SIZE(mv88e6xxx_hw_stats
); i
++) {
855 stat
= &mv88e6xxx_hw_stats
[i
];
856 if (stat
->type
& types
) {
857 memcpy(data
+ j
* ETH_GSTRING_LEN
, stat
->string
,
864 static void mv88e6095_stats_get_strings(struct mv88e6xxx_chip
*chip
,
867 mv88e6xxx_stats_get_strings(chip
, data
,
868 STATS_TYPE_BANK0
| STATS_TYPE_PORT
);
871 static void mv88e6320_stats_get_strings(struct mv88e6xxx_chip
*chip
,
874 mv88e6xxx_stats_get_strings(chip
, data
,
875 STATS_TYPE_BANK0
| STATS_TYPE_BANK1
);
878 static void mv88e6xxx_get_strings(struct dsa_switch
*ds
, int port
,
881 struct mv88e6xxx_chip
*chip
= ds
->priv
;
883 if (chip
->info
->ops
->stats_get_strings
)
884 chip
->info
->ops
->stats_get_strings(chip
, data
);
887 static int mv88e6xxx_stats_get_sset_count(struct mv88e6xxx_chip
*chip
,
890 struct mv88e6xxx_hw_stat
*stat
;
893 for (i
= 0, j
= 0; i
< ARRAY_SIZE(mv88e6xxx_hw_stats
); i
++) {
894 stat
= &mv88e6xxx_hw_stats
[i
];
895 if (stat
->type
& types
)
901 static int mv88e6095_stats_get_sset_count(struct mv88e6xxx_chip
*chip
)
903 return mv88e6xxx_stats_get_sset_count(chip
, STATS_TYPE_BANK0
|
907 static int mv88e6320_stats_get_sset_count(struct mv88e6xxx_chip
*chip
)
909 return mv88e6xxx_stats_get_sset_count(chip
, STATS_TYPE_BANK0
|
913 static int mv88e6xxx_get_sset_count(struct dsa_switch
*ds
)
915 struct mv88e6xxx_chip
*chip
= ds
->priv
;
917 if (chip
->info
->ops
->stats_get_sset_count
)
918 return chip
->info
->ops
->stats_get_sset_count(chip
);
923 static void mv88e6xxx_stats_get_stats(struct mv88e6xxx_chip
*chip
, int port
,
924 uint64_t *data
, int types
,
925 u16 bank1_select
, u16 histogram
)
927 struct mv88e6xxx_hw_stat
*stat
;
930 for (i
= 0, j
= 0; i
< ARRAY_SIZE(mv88e6xxx_hw_stats
); i
++) {
931 stat
= &mv88e6xxx_hw_stats
[i
];
932 if (stat
->type
& types
) {
933 data
[j
] = _mv88e6xxx_get_ethtool_stat(chip
, stat
, port
,
941 static void mv88e6095_stats_get_stats(struct mv88e6xxx_chip
*chip
, int port
,
944 return mv88e6xxx_stats_get_stats(chip
, port
, data
,
945 STATS_TYPE_BANK0
| STATS_TYPE_PORT
,
946 0, GLOBAL_STATS_OP_HIST_RX_TX
);
949 static void mv88e6320_stats_get_stats(struct mv88e6xxx_chip
*chip
, int port
,
952 return mv88e6xxx_stats_get_stats(chip
, port
, data
,
953 STATS_TYPE_BANK0
| STATS_TYPE_BANK1
,
954 GLOBAL_STATS_OP_BANK_1_BIT_9
,
955 GLOBAL_STATS_OP_HIST_RX_TX
);
958 static void mv88e6390_stats_get_stats(struct mv88e6xxx_chip
*chip
, int port
,
961 return mv88e6xxx_stats_get_stats(chip
, port
, data
,
962 STATS_TYPE_BANK0
| STATS_TYPE_BANK1
,
963 GLOBAL_STATS_OP_BANK_1_BIT_10
, 0);
966 static void mv88e6xxx_get_stats(struct mv88e6xxx_chip
*chip
, int port
,
969 if (chip
->info
->ops
->stats_get_stats
)
970 chip
->info
->ops
->stats_get_stats(chip
, port
, data
);
973 static void mv88e6xxx_get_ethtool_stats(struct dsa_switch
*ds
, int port
,
976 struct mv88e6xxx_chip
*chip
= ds
->priv
;
979 mutex_lock(&chip
->reg_lock
);
981 ret
= mv88e6xxx_stats_snapshot(chip
, port
);
983 mutex_unlock(&chip
->reg_lock
);
987 mv88e6xxx_get_stats(chip
, port
, data
);
989 mutex_unlock(&chip
->reg_lock
);
992 static int mv88e6xxx_stats_set_histogram(struct mv88e6xxx_chip
*chip
)
994 if (chip
->info
->ops
->stats_set_histogram
)
995 return chip
->info
->ops
->stats_set_histogram(chip
);
1000 static int mv88e6xxx_get_regs_len(struct dsa_switch
*ds
, int port
)
1002 return 32 * sizeof(u16
);
1005 static void mv88e6xxx_get_regs(struct dsa_switch
*ds
, int port
,
1006 struct ethtool_regs
*regs
, void *_p
)
1008 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1016 memset(p
, 0xff, 32 * sizeof(u16
));
1018 mutex_lock(&chip
->reg_lock
);
1020 for (i
= 0; i
< 32; i
++) {
1022 err
= mv88e6xxx_port_read(chip
, port
, i
, ®
);
1027 mutex_unlock(&chip
->reg_lock
);
1030 static int _mv88e6xxx_atu_wait(struct mv88e6xxx_chip
*chip
)
1032 return mv88e6xxx_g1_wait(chip
, GLOBAL_ATU_OP
, GLOBAL_ATU_OP_BUSY
);
1035 static int mv88e6xxx_get_eee(struct dsa_switch
*ds
, int port
,
1036 struct ethtool_eee
*e
)
1038 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1042 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_EEE
))
1045 mutex_lock(&chip
->reg_lock
);
1047 err
= mv88e6xxx_phy_read(chip
, port
, 16, ®
);
1051 e
->eee_enabled
= !!(reg
& 0x0200);
1052 e
->tx_lpi_enabled
= !!(reg
& 0x0100);
1054 err
= mv88e6xxx_port_read(chip
, port
, PORT_STATUS
, ®
);
1058 e
->eee_active
= !!(reg
& PORT_STATUS_EEE
);
1060 mutex_unlock(&chip
->reg_lock
);
1065 static int mv88e6xxx_set_eee(struct dsa_switch
*ds
, int port
,
1066 struct phy_device
*phydev
, struct ethtool_eee
*e
)
1068 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1072 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_EEE
))
1075 mutex_lock(&chip
->reg_lock
);
1077 err
= mv88e6xxx_phy_read(chip
, port
, 16, ®
);
1084 if (e
->tx_lpi_enabled
)
1087 err
= mv88e6xxx_phy_write(chip
, port
, 16, reg
);
1089 mutex_unlock(&chip
->reg_lock
);
1094 static int _mv88e6xxx_atu_cmd(struct mv88e6xxx_chip
*chip
, u16 fid
, u16 cmd
)
1099 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAG_G1_ATU_FID
)) {
1100 err
= mv88e6xxx_g1_write(chip
, GLOBAL_ATU_FID
, fid
);
1103 } else if (mv88e6xxx_num_databases(chip
) == 256) {
1104 /* ATU DBNum[7:4] are located in ATU Control 15:12 */
1105 err
= mv88e6xxx_g1_read(chip
, GLOBAL_ATU_CONTROL
, &val
);
1109 err
= mv88e6xxx_g1_write(chip
, GLOBAL_ATU_CONTROL
,
1110 (val
& 0xfff) | ((fid
<< 8) & 0xf000));
1114 /* ATU DBNum[3:0] are located in ATU Operation 3:0 */
1118 err
= mv88e6xxx_g1_write(chip
, GLOBAL_ATU_OP
, cmd
);
1122 return _mv88e6xxx_atu_wait(chip
);
1125 static int _mv88e6xxx_atu_data_write(struct mv88e6xxx_chip
*chip
,
1126 struct mv88e6xxx_atu_entry
*entry
)
1128 u16 data
= entry
->state
& GLOBAL_ATU_DATA_STATE_MASK
;
1130 if (entry
->state
!= GLOBAL_ATU_DATA_STATE_UNUSED
) {
1131 unsigned int mask
, shift
;
1134 data
|= GLOBAL_ATU_DATA_TRUNK
;
1135 mask
= GLOBAL_ATU_DATA_TRUNK_ID_MASK
;
1136 shift
= GLOBAL_ATU_DATA_TRUNK_ID_SHIFT
;
1138 mask
= GLOBAL_ATU_DATA_PORT_VECTOR_MASK
;
1139 shift
= GLOBAL_ATU_DATA_PORT_VECTOR_SHIFT
;
1142 data
|= (entry
->portv_trunkid
<< shift
) & mask
;
1145 return mv88e6xxx_g1_write(chip
, GLOBAL_ATU_DATA
, data
);
1148 static int _mv88e6xxx_atu_flush_move(struct mv88e6xxx_chip
*chip
,
1149 struct mv88e6xxx_atu_entry
*entry
,
1155 err
= _mv88e6xxx_atu_wait(chip
);
1159 err
= _mv88e6xxx_atu_data_write(chip
, entry
);
1164 op
= static_too
? GLOBAL_ATU_OP_FLUSH_MOVE_ALL_DB
:
1165 GLOBAL_ATU_OP_FLUSH_MOVE_NON_STATIC_DB
;
1167 op
= static_too
? GLOBAL_ATU_OP_FLUSH_MOVE_ALL
:
1168 GLOBAL_ATU_OP_FLUSH_MOVE_NON_STATIC
;
1171 return _mv88e6xxx_atu_cmd(chip
, entry
->fid
, op
);
1174 static int _mv88e6xxx_atu_flush(struct mv88e6xxx_chip
*chip
,
1175 u16 fid
, bool static_too
)
1177 struct mv88e6xxx_atu_entry entry
= {
1179 .state
= 0, /* EntryState bits must be 0 */
1182 return _mv88e6xxx_atu_flush_move(chip
, &entry
, static_too
);
1185 static int _mv88e6xxx_atu_move(struct mv88e6xxx_chip
*chip
, u16 fid
,
1186 int from_port
, int to_port
, bool static_too
)
1188 struct mv88e6xxx_atu_entry entry
= {
1193 /* EntryState bits must be 0xF */
1194 entry
.state
= GLOBAL_ATU_DATA_STATE_MASK
;
1196 /* ToPort and FromPort are respectively in PortVec bits 7:4 and 3:0 */
1197 entry
.portv_trunkid
= (to_port
& 0x0f) << 4;
1198 entry
.portv_trunkid
|= from_port
& 0x0f;
1200 return _mv88e6xxx_atu_flush_move(chip
, &entry
, static_too
);
1203 static int _mv88e6xxx_atu_remove(struct mv88e6xxx_chip
*chip
, u16 fid
,
1204 int port
, bool static_too
)
1206 /* Destination port 0xF means remove the entries */
1207 return _mv88e6xxx_atu_move(chip
, fid
, port
, 0x0f, static_too
);
1210 static int _mv88e6xxx_port_based_vlan_map(struct mv88e6xxx_chip
*chip
, int port
)
1212 struct net_device
*bridge
= chip
->ports
[port
].bridge_dev
;
1213 struct dsa_switch
*ds
= chip
->ds
;
1214 u16 output_ports
= 0;
1217 /* allow CPU port or DSA link(s) to send frames to every port */
1218 if (dsa_is_cpu_port(ds
, port
) || dsa_is_dsa_port(ds
, port
)) {
1221 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); ++i
) {
1222 /* allow sending frames to every group member */
1223 if (bridge
&& chip
->ports
[i
].bridge_dev
== bridge
)
1224 output_ports
|= BIT(i
);
1226 /* allow sending frames to CPU port and DSA link(s) */
1227 if (dsa_is_cpu_port(ds
, i
) || dsa_is_dsa_port(ds
, i
))
1228 output_ports
|= BIT(i
);
1232 /* prevent frames from going back out of the port they came in on */
1233 output_ports
&= ~BIT(port
);
1235 return mv88e6xxx_port_set_vlan_map(chip
, port
, output_ports
);
1238 static void mv88e6xxx_port_stp_state_set(struct dsa_switch
*ds
, int port
,
1241 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1246 case BR_STATE_DISABLED
:
1247 stp_state
= PORT_CONTROL_STATE_DISABLED
;
1249 case BR_STATE_BLOCKING
:
1250 case BR_STATE_LISTENING
:
1251 stp_state
= PORT_CONTROL_STATE_BLOCKING
;
1253 case BR_STATE_LEARNING
:
1254 stp_state
= PORT_CONTROL_STATE_LEARNING
;
1256 case BR_STATE_FORWARDING
:
1258 stp_state
= PORT_CONTROL_STATE_FORWARDING
;
1262 mutex_lock(&chip
->reg_lock
);
1263 err
= mv88e6xxx_port_set_state(chip
, port
, stp_state
);
1264 mutex_unlock(&chip
->reg_lock
);
1267 netdev_err(ds
->ports
[port
].netdev
, "failed to update state\n");
1270 static void mv88e6xxx_port_fast_age(struct dsa_switch
*ds
, int port
)
1272 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1275 mutex_lock(&chip
->reg_lock
);
1276 err
= _mv88e6xxx_atu_remove(chip
, 0, port
, false);
1277 mutex_unlock(&chip
->reg_lock
);
1280 netdev_err(ds
->ports
[port
].netdev
, "failed to flush ATU\n");
1283 static int _mv88e6xxx_vtu_wait(struct mv88e6xxx_chip
*chip
)
1285 return mv88e6xxx_g1_wait(chip
, GLOBAL_VTU_OP
, GLOBAL_VTU_OP_BUSY
);
1288 static int _mv88e6xxx_vtu_cmd(struct mv88e6xxx_chip
*chip
, u16 op
)
1292 err
= mv88e6xxx_g1_write(chip
, GLOBAL_VTU_OP
, op
);
1296 return _mv88e6xxx_vtu_wait(chip
);
1299 static int _mv88e6xxx_vtu_stu_flush(struct mv88e6xxx_chip
*chip
)
1303 ret
= _mv88e6xxx_vtu_wait(chip
);
1307 return _mv88e6xxx_vtu_cmd(chip
, GLOBAL_VTU_OP_FLUSH_ALL
);
1310 static int _mv88e6xxx_vtu_stu_data_read(struct mv88e6xxx_chip
*chip
,
1311 struct mv88e6xxx_vtu_entry
*entry
,
1312 unsigned int nibble_offset
)
1317 for (i
= 0; i
< 3; ++i
) {
1318 u16
*reg
= ®s
[i
];
1320 err
= mv88e6xxx_g1_read(chip
, GLOBAL_VTU_DATA_0_3
+ i
, reg
);
1325 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); ++i
) {
1326 unsigned int shift
= (i
% 4) * 4 + nibble_offset
;
1327 u16 reg
= regs
[i
/ 4];
1329 entry
->data
[i
] = (reg
>> shift
) & GLOBAL_VTU_STU_DATA_MASK
;
1335 static int mv88e6xxx_vtu_data_read(struct mv88e6xxx_chip
*chip
,
1336 struct mv88e6xxx_vtu_entry
*entry
)
1338 return _mv88e6xxx_vtu_stu_data_read(chip
, entry
, 0);
1341 static int mv88e6xxx_stu_data_read(struct mv88e6xxx_chip
*chip
,
1342 struct mv88e6xxx_vtu_entry
*entry
)
1344 return _mv88e6xxx_vtu_stu_data_read(chip
, entry
, 2);
1347 static int _mv88e6xxx_vtu_stu_data_write(struct mv88e6xxx_chip
*chip
,
1348 struct mv88e6xxx_vtu_entry
*entry
,
1349 unsigned int nibble_offset
)
1351 u16 regs
[3] = { 0 };
1354 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); ++i
) {
1355 unsigned int shift
= (i
% 4) * 4 + nibble_offset
;
1356 u8 data
= entry
->data
[i
];
1358 regs
[i
/ 4] |= (data
& GLOBAL_VTU_STU_DATA_MASK
) << shift
;
1361 for (i
= 0; i
< 3; ++i
) {
1364 err
= mv88e6xxx_g1_write(chip
, GLOBAL_VTU_DATA_0_3
+ i
, reg
);
1372 static int mv88e6xxx_vtu_data_write(struct mv88e6xxx_chip
*chip
,
1373 struct mv88e6xxx_vtu_entry
*entry
)
1375 return _mv88e6xxx_vtu_stu_data_write(chip
, entry
, 0);
1378 static int mv88e6xxx_stu_data_write(struct mv88e6xxx_chip
*chip
,
1379 struct mv88e6xxx_vtu_entry
*entry
)
1381 return _mv88e6xxx_vtu_stu_data_write(chip
, entry
, 2);
1384 static int _mv88e6xxx_vtu_vid_write(struct mv88e6xxx_chip
*chip
, u16 vid
)
1386 return mv88e6xxx_g1_write(chip
, GLOBAL_VTU_VID
,
1387 vid
& GLOBAL_VTU_VID_MASK
);
1390 static int _mv88e6xxx_vtu_getnext(struct mv88e6xxx_chip
*chip
,
1391 struct mv88e6xxx_vtu_entry
*entry
)
1393 struct mv88e6xxx_vtu_entry next
= { 0 };
1397 err
= _mv88e6xxx_vtu_wait(chip
);
1401 err
= _mv88e6xxx_vtu_cmd(chip
, GLOBAL_VTU_OP_VTU_GET_NEXT
);
1405 err
= mv88e6xxx_g1_read(chip
, GLOBAL_VTU_VID
, &val
);
1409 next
.vid
= val
& GLOBAL_VTU_VID_MASK
;
1410 next
.valid
= !!(val
& GLOBAL_VTU_VID_VALID
);
1413 err
= mv88e6xxx_vtu_data_read(chip
, &next
);
1417 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAG_G1_VTU_FID
)) {
1418 err
= mv88e6xxx_g1_read(chip
, GLOBAL_VTU_FID
, &val
);
1422 next
.fid
= val
& GLOBAL_VTU_FID_MASK
;
1423 } else if (mv88e6xxx_num_databases(chip
) == 256) {
1424 /* VTU DBNum[7:4] are located in VTU Operation 11:8, and
1425 * VTU DBNum[3:0] are located in VTU Operation 3:0
1427 err
= mv88e6xxx_g1_read(chip
, GLOBAL_VTU_OP
, &val
);
1431 next
.fid
= (val
& 0xf00) >> 4;
1432 next
.fid
|= val
& 0xf;
1435 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAG_STU
)) {
1436 err
= mv88e6xxx_g1_read(chip
, GLOBAL_VTU_SID
, &val
);
1440 next
.sid
= val
& GLOBAL_VTU_SID_MASK
;
1448 static int mv88e6xxx_port_vlan_dump(struct dsa_switch
*ds
, int port
,
1449 struct switchdev_obj_port_vlan
*vlan
,
1450 int (*cb
)(struct switchdev_obj
*obj
))
1452 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1453 struct mv88e6xxx_vtu_entry next
;
1457 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_VTU
))
1460 mutex_lock(&chip
->reg_lock
);
1462 err
= mv88e6xxx_port_get_pvid(chip
, port
, &pvid
);
1466 err
= _mv88e6xxx_vtu_vid_write(chip
, GLOBAL_VTU_VID_MASK
);
1471 err
= _mv88e6xxx_vtu_getnext(chip
, &next
);
1478 if (next
.data
[port
] == GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER
)
1481 /* reinit and dump this VLAN obj */
1482 vlan
->vid_begin
= next
.vid
;
1483 vlan
->vid_end
= next
.vid
;
1486 if (next
.data
[port
] == GLOBAL_VTU_DATA_MEMBER_TAG_UNTAGGED
)
1487 vlan
->flags
|= BRIDGE_VLAN_INFO_UNTAGGED
;
1489 if (next
.vid
== pvid
)
1490 vlan
->flags
|= BRIDGE_VLAN_INFO_PVID
;
1492 err
= cb(&vlan
->obj
);
1495 } while (next
.vid
< GLOBAL_VTU_VID_MASK
);
1498 mutex_unlock(&chip
->reg_lock
);
1503 static int _mv88e6xxx_vtu_loadpurge(struct mv88e6xxx_chip
*chip
,
1504 struct mv88e6xxx_vtu_entry
*entry
)
1506 u16 op
= GLOBAL_VTU_OP_VTU_LOAD_PURGE
;
1510 err
= _mv88e6xxx_vtu_wait(chip
);
1517 /* Write port member tags */
1518 err
= mv88e6xxx_vtu_data_write(chip
, entry
);
1522 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAG_STU
)) {
1523 reg
= entry
->sid
& GLOBAL_VTU_SID_MASK
;
1524 err
= mv88e6xxx_g1_write(chip
, GLOBAL_VTU_SID
, reg
);
1529 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAG_G1_VTU_FID
)) {
1530 reg
= entry
->fid
& GLOBAL_VTU_FID_MASK
;
1531 err
= mv88e6xxx_g1_write(chip
, GLOBAL_VTU_FID
, reg
);
1534 } else if (mv88e6xxx_num_databases(chip
) == 256) {
1535 /* VTU DBNum[7:4] are located in VTU Operation 11:8, and
1536 * VTU DBNum[3:0] are located in VTU Operation 3:0
1538 op
|= (entry
->fid
& 0xf0) << 8;
1539 op
|= entry
->fid
& 0xf;
1542 reg
= GLOBAL_VTU_VID_VALID
;
1544 reg
|= entry
->vid
& GLOBAL_VTU_VID_MASK
;
1545 err
= mv88e6xxx_g1_write(chip
, GLOBAL_VTU_VID
, reg
);
1549 return _mv88e6xxx_vtu_cmd(chip
, op
);
1552 static int _mv88e6xxx_stu_getnext(struct mv88e6xxx_chip
*chip
, u8 sid
,
1553 struct mv88e6xxx_vtu_entry
*entry
)
1555 struct mv88e6xxx_vtu_entry next
= { 0 };
1559 err
= _mv88e6xxx_vtu_wait(chip
);
1563 err
= mv88e6xxx_g1_write(chip
, GLOBAL_VTU_SID
,
1564 sid
& GLOBAL_VTU_SID_MASK
);
1568 err
= _mv88e6xxx_vtu_cmd(chip
, GLOBAL_VTU_OP_STU_GET_NEXT
);
1572 err
= mv88e6xxx_g1_read(chip
, GLOBAL_VTU_SID
, &val
);
1576 next
.sid
= val
& GLOBAL_VTU_SID_MASK
;
1578 err
= mv88e6xxx_g1_read(chip
, GLOBAL_VTU_VID
, &val
);
1582 next
.valid
= !!(val
& GLOBAL_VTU_VID_VALID
);
1585 err
= mv88e6xxx_stu_data_read(chip
, &next
);
1594 static int _mv88e6xxx_stu_loadpurge(struct mv88e6xxx_chip
*chip
,
1595 struct mv88e6xxx_vtu_entry
*entry
)
1600 err
= _mv88e6xxx_vtu_wait(chip
);
1607 /* Write port states */
1608 err
= mv88e6xxx_stu_data_write(chip
, entry
);
1612 reg
= GLOBAL_VTU_VID_VALID
;
1614 err
= mv88e6xxx_g1_write(chip
, GLOBAL_VTU_VID
, reg
);
1618 reg
= entry
->sid
& GLOBAL_VTU_SID_MASK
;
1619 err
= mv88e6xxx_g1_write(chip
, GLOBAL_VTU_SID
, reg
);
1623 return _mv88e6xxx_vtu_cmd(chip
, GLOBAL_VTU_OP_STU_LOAD_PURGE
);
1626 static int _mv88e6xxx_fid_new(struct mv88e6xxx_chip
*chip
, u16
*fid
)
1628 DECLARE_BITMAP(fid_bitmap
, MV88E6XXX_N_FID
);
1629 struct mv88e6xxx_vtu_entry vlan
;
1632 bitmap_zero(fid_bitmap
, MV88E6XXX_N_FID
);
1634 /* Set every FID bit used by the (un)bridged ports */
1635 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); ++i
) {
1636 err
= mv88e6xxx_port_get_fid(chip
, i
, fid
);
1640 set_bit(*fid
, fid_bitmap
);
1643 /* Set every FID bit used by the VLAN entries */
1644 err
= _mv88e6xxx_vtu_vid_write(chip
, GLOBAL_VTU_VID_MASK
);
1649 err
= _mv88e6xxx_vtu_getnext(chip
, &vlan
);
1656 set_bit(vlan
.fid
, fid_bitmap
);
1657 } while (vlan
.vid
< GLOBAL_VTU_VID_MASK
);
1659 /* The reset value 0x000 is used to indicate that multiple address
1660 * databases are not needed. Return the next positive available.
1662 *fid
= find_next_zero_bit(fid_bitmap
, MV88E6XXX_N_FID
, 1);
1663 if (unlikely(*fid
>= mv88e6xxx_num_databases(chip
)))
1666 /* Clear the database */
1667 return _mv88e6xxx_atu_flush(chip
, *fid
, true);
1670 static int _mv88e6xxx_vtu_new(struct mv88e6xxx_chip
*chip
, u16 vid
,
1671 struct mv88e6xxx_vtu_entry
*entry
)
1673 struct dsa_switch
*ds
= chip
->ds
;
1674 struct mv88e6xxx_vtu_entry vlan
= {
1680 err
= _mv88e6xxx_fid_new(chip
, &vlan
.fid
);
1684 /* exclude all ports except the CPU and DSA ports */
1685 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); ++i
)
1686 vlan
.data
[i
] = dsa_is_cpu_port(ds
, i
) || dsa_is_dsa_port(ds
, i
)
1687 ? GLOBAL_VTU_DATA_MEMBER_TAG_UNMODIFIED
1688 : GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER
;
1690 if (mv88e6xxx_6097_family(chip
) || mv88e6xxx_6165_family(chip
) ||
1691 mv88e6xxx_6351_family(chip
) || mv88e6xxx_6352_family(chip
)) {
1692 struct mv88e6xxx_vtu_entry vstp
;
1694 /* Adding a VTU entry requires a valid STU entry. As VSTP is not
1695 * implemented, only one STU entry is needed to cover all VTU
1696 * entries. Thus, validate the SID 0.
1699 err
= _mv88e6xxx_stu_getnext(chip
, GLOBAL_VTU_SID_MASK
, &vstp
);
1703 if (vstp
.sid
!= vlan
.sid
|| !vstp
.valid
) {
1704 memset(&vstp
, 0, sizeof(vstp
));
1706 vstp
.sid
= vlan
.sid
;
1708 err
= _mv88e6xxx_stu_loadpurge(chip
, &vstp
);
1718 static int _mv88e6xxx_vtu_get(struct mv88e6xxx_chip
*chip
, u16 vid
,
1719 struct mv88e6xxx_vtu_entry
*entry
, bool creat
)
1726 err
= _mv88e6xxx_vtu_vid_write(chip
, vid
- 1);
1730 err
= _mv88e6xxx_vtu_getnext(chip
, entry
);
1734 if (entry
->vid
!= vid
|| !entry
->valid
) {
1737 /* -ENOENT would've been more appropriate, but switchdev expects
1738 * -EOPNOTSUPP to inform bridge about an eventual software VLAN.
1741 err
= _mv88e6xxx_vtu_new(chip
, vid
, entry
);
1747 static int mv88e6xxx_port_check_hw_vlan(struct dsa_switch
*ds
, int port
,
1748 u16 vid_begin
, u16 vid_end
)
1750 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1751 struct mv88e6xxx_vtu_entry vlan
;
1757 mutex_lock(&chip
->reg_lock
);
1759 err
= _mv88e6xxx_vtu_vid_write(chip
, vid_begin
- 1);
1764 err
= _mv88e6xxx_vtu_getnext(chip
, &vlan
);
1771 if (vlan
.vid
> vid_end
)
1774 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); ++i
) {
1775 if (dsa_is_dsa_port(ds
, i
) || dsa_is_cpu_port(ds
, i
))
1778 if (!ds
->ports
[port
].netdev
)
1782 GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER
)
1785 if (chip
->ports
[i
].bridge_dev
==
1786 chip
->ports
[port
].bridge_dev
)
1787 break; /* same bridge, check next VLAN */
1789 if (!chip
->ports
[i
].bridge_dev
)
1792 netdev_warn(ds
->ports
[port
].netdev
,
1793 "hardware VLAN %d already used by %s\n",
1795 netdev_name(chip
->ports
[i
].bridge_dev
));
1799 } while (vlan
.vid
< vid_end
);
1802 mutex_unlock(&chip
->reg_lock
);
1807 static int mv88e6xxx_port_vlan_filtering(struct dsa_switch
*ds
, int port
,
1808 bool vlan_filtering
)
1810 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1811 u16 mode
= vlan_filtering
? PORT_CONTROL_2_8021Q_SECURE
:
1812 PORT_CONTROL_2_8021Q_DISABLED
;
1815 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_VTU
))
1818 mutex_lock(&chip
->reg_lock
);
1819 err
= mv88e6xxx_port_set_8021q_mode(chip
, port
, mode
);
1820 mutex_unlock(&chip
->reg_lock
);
1826 mv88e6xxx_port_vlan_prepare(struct dsa_switch
*ds
, int port
,
1827 const struct switchdev_obj_port_vlan
*vlan
,
1828 struct switchdev_trans
*trans
)
1830 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1833 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_VTU
))
1836 /* If the requested port doesn't belong to the same bridge as the VLAN
1837 * members, do not support it (yet) and fallback to software VLAN.
1839 err
= mv88e6xxx_port_check_hw_vlan(ds
, port
, vlan
->vid_begin
,
1844 /* We don't need any dynamic resource from the kernel (yet),
1845 * so skip the prepare phase.
1850 static int _mv88e6xxx_port_vlan_add(struct mv88e6xxx_chip
*chip
, int port
,
1851 u16 vid
, bool untagged
)
1853 struct mv88e6xxx_vtu_entry vlan
;
1856 err
= _mv88e6xxx_vtu_get(chip
, vid
, &vlan
, true);
1860 vlan
.data
[port
] = untagged
?
1861 GLOBAL_VTU_DATA_MEMBER_TAG_UNTAGGED
:
1862 GLOBAL_VTU_DATA_MEMBER_TAG_TAGGED
;
1864 return _mv88e6xxx_vtu_loadpurge(chip
, &vlan
);
1867 static void mv88e6xxx_port_vlan_add(struct dsa_switch
*ds
, int port
,
1868 const struct switchdev_obj_port_vlan
*vlan
,
1869 struct switchdev_trans
*trans
)
1871 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1872 bool untagged
= vlan
->flags
& BRIDGE_VLAN_INFO_UNTAGGED
;
1873 bool pvid
= vlan
->flags
& BRIDGE_VLAN_INFO_PVID
;
1876 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_VTU
))
1879 mutex_lock(&chip
->reg_lock
);
1881 for (vid
= vlan
->vid_begin
; vid
<= vlan
->vid_end
; ++vid
)
1882 if (_mv88e6xxx_port_vlan_add(chip
, port
, vid
, untagged
))
1883 netdev_err(ds
->ports
[port
].netdev
,
1884 "failed to add VLAN %d%c\n",
1885 vid
, untagged
? 'u' : 't');
1887 if (pvid
&& mv88e6xxx_port_set_pvid(chip
, port
, vlan
->vid_end
))
1888 netdev_err(ds
->ports
[port
].netdev
, "failed to set PVID %d\n",
1891 mutex_unlock(&chip
->reg_lock
);
1894 static int _mv88e6xxx_port_vlan_del(struct mv88e6xxx_chip
*chip
,
1897 struct dsa_switch
*ds
= chip
->ds
;
1898 struct mv88e6xxx_vtu_entry vlan
;
1901 err
= _mv88e6xxx_vtu_get(chip
, vid
, &vlan
, false);
1905 /* Tell switchdev if this VLAN is handled in software */
1906 if (vlan
.data
[port
] == GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER
)
1909 vlan
.data
[port
] = GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER
;
1911 /* keep the VLAN unless all ports are excluded */
1913 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); ++i
) {
1914 if (dsa_is_cpu_port(ds
, i
) || dsa_is_dsa_port(ds
, i
))
1917 if (vlan
.data
[i
] != GLOBAL_VTU_DATA_MEMBER_TAG_NON_MEMBER
) {
1923 err
= _mv88e6xxx_vtu_loadpurge(chip
, &vlan
);
1927 return _mv88e6xxx_atu_remove(chip
, vlan
.fid
, port
, false);
1930 static int mv88e6xxx_port_vlan_del(struct dsa_switch
*ds
, int port
,
1931 const struct switchdev_obj_port_vlan
*vlan
)
1933 struct mv88e6xxx_chip
*chip
= ds
->priv
;
1937 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_VTU
))
1940 mutex_lock(&chip
->reg_lock
);
1942 err
= mv88e6xxx_port_get_pvid(chip
, port
, &pvid
);
1946 for (vid
= vlan
->vid_begin
; vid
<= vlan
->vid_end
; ++vid
) {
1947 err
= _mv88e6xxx_port_vlan_del(chip
, port
, vid
);
1952 err
= mv88e6xxx_port_set_pvid(chip
, port
, 0);
1959 mutex_unlock(&chip
->reg_lock
);
1964 static int _mv88e6xxx_atu_mac_write(struct mv88e6xxx_chip
*chip
,
1965 const unsigned char *addr
)
1969 for (i
= 0; i
< 3; i
++) {
1970 err
= mv88e6xxx_g1_write(chip
, GLOBAL_ATU_MAC_01
+ i
,
1971 (addr
[i
* 2] << 8) | addr
[i
* 2 + 1]);
1979 static int _mv88e6xxx_atu_mac_read(struct mv88e6xxx_chip
*chip
,
1980 unsigned char *addr
)
1985 for (i
= 0; i
< 3; i
++) {
1986 err
= mv88e6xxx_g1_read(chip
, GLOBAL_ATU_MAC_01
+ i
, &val
);
1990 addr
[i
* 2] = val
>> 8;
1991 addr
[i
* 2 + 1] = val
& 0xff;
1997 static int _mv88e6xxx_atu_load(struct mv88e6xxx_chip
*chip
,
1998 struct mv88e6xxx_atu_entry
*entry
)
2002 ret
= _mv88e6xxx_atu_wait(chip
);
2006 ret
= _mv88e6xxx_atu_mac_write(chip
, entry
->mac
);
2010 ret
= _mv88e6xxx_atu_data_write(chip
, entry
);
2014 return _mv88e6xxx_atu_cmd(chip
, entry
->fid
, GLOBAL_ATU_OP_LOAD_DB
);
2017 static int _mv88e6xxx_atu_getnext(struct mv88e6xxx_chip
*chip
, u16 fid
,
2018 struct mv88e6xxx_atu_entry
*entry
);
2020 static int mv88e6xxx_atu_get(struct mv88e6xxx_chip
*chip
, int fid
,
2021 const u8
*addr
, struct mv88e6xxx_atu_entry
*entry
)
2023 struct mv88e6xxx_atu_entry next
;
2026 memcpy(next
.mac
, addr
, ETH_ALEN
);
2027 eth_addr_dec(next
.mac
);
2029 err
= _mv88e6xxx_atu_mac_write(chip
, next
.mac
);
2034 err
= _mv88e6xxx_atu_getnext(chip
, fid
, &next
);
2038 if (next
.state
== GLOBAL_ATU_DATA_STATE_UNUSED
)
2041 if (ether_addr_equal(next
.mac
, addr
)) {
2045 } while (ether_addr_greater(addr
, next
.mac
));
2047 memset(entry
, 0, sizeof(*entry
));
2049 ether_addr_copy(entry
->mac
, addr
);
2054 static int mv88e6xxx_port_db_load_purge(struct mv88e6xxx_chip
*chip
, int port
,
2055 const unsigned char *addr
, u16 vid
,
2058 struct mv88e6xxx_vtu_entry vlan
;
2059 struct mv88e6xxx_atu_entry entry
;
2062 /* Null VLAN ID corresponds to the port private database */
2064 err
= mv88e6xxx_port_get_fid(chip
, port
, &vlan
.fid
);
2066 err
= _mv88e6xxx_vtu_get(chip
, vid
, &vlan
, false);
2070 err
= mv88e6xxx_atu_get(chip
, vlan
.fid
, addr
, &entry
);
2074 /* Purge the ATU entry only if no port is using it anymore */
2075 if (state
== GLOBAL_ATU_DATA_STATE_UNUSED
) {
2076 entry
.portv_trunkid
&= ~BIT(port
);
2077 if (!entry
.portv_trunkid
)
2078 entry
.state
= GLOBAL_ATU_DATA_STATE_UNUSED
;
2080 entry
.portv_trunkid
|= BIT(port
);
2081 entry
.state
= state
;
2084 return _mv88e6xxx_atu_load(chip
, &entry
);
2087 static int mv88e6xxx_port_fdb_prepare(struct dsa_switch
*ds
, int port
,
2088 const struct switchdev_obj_port_fdb
*fdb
,
2089 struct switchdev_trans
*trans
)
2091 /* We don't need any dynamic resource from the kernel (yet),
2092 * so skip the prepare phase.
2097 static void mv88e6xxx_port_fdb_add(struct dsa_switch
*ds
, int port
,
2098 const struct switchdev_obj_port_fdb
*fdb
,
2099 struct switchdev_trans
*trans
)
2101 struct mv88e6xxx_chip
*chip
= ds
->priv
;
2103 mutex_lock(&chip
->reg_lock
);
2104 if (mv88e6xxx_port_db_load_purge(chip
, port
, fdb
->addr
, fdb
->vid
,
2105 GLOBAL_ATU_DATA_STATE_UC_STATIC
))
2106 netdev_err(ds
->ports
[port
].netdev
, "failed to load unicast MAC address\n");
2107 mutex_unlock(&chip
->reg_lock
);
2110 static int mv88e6xxx_port_fdb_del(struct dsa_switch
*ds
, int port
,
2111 const struct switchdev_obj_port_fdb
*fdb
)
2113 struct mv88e6xxx_chip
*chip
= ds
->priv
;
2116 mutex_lock(&chip
->reg_lock
);
2117 err
= mv88e6xxx_port_db_load_purge(chip
, port
, fdb
->addr
, fdb
->vid
,
2118 GLOBAL_ATU_DATA_STATE_UNUSED
);
2119 mutex_unlock(&chip
->reg_lock
);
2124 static int _mv88e6xxx_atu_getnext(struct mv88e6xxx_chip
*chip
, u16 fid
,
2125 struct mv88e6xxx_atu_entry
*entry
)
2127 struct mv88e6xxx_atu_entry next
= { 0 };
2133 err
= _mv88e6xxx_atu_wait(chip
);
2137 err
= _mv88e6xxx_atu_cmd(chip
, fid
, GLOBAL_ATU_OP_GET_NEXT_DB
);
2141 err
= _mv88e6xxx_atu_mac_read(chip
, next
.mac
);
2145 err
= mv88e6xxx_g1_read(chip
, GLOBAL_ATU_DATA
, &val
);
2149 next
.state
= val
& GLOBAL_ATU_DATA_STATE_MASK
;
2150 if (next
.state
!= GLOBAL_ATU_DATA_STATE_UNUSED
) {
2151 unsigned int mask
, shift
;
2153 if (val
& GLOBAL_ATU_DATA_TRUNK
) {
2155 mask
= GLOBAL_ATU_DATA_TRUNK_ID_MASK
;
2156 shift
= GLOBAL_ATU_DATA_TRUNK_ID_SHIFT
;
2159 mask
= GLOBAL_ATU_DATA_PORT_VECTOR_MASK
;
2160 shift
= GLOBAL_ATU_DATA_PORT_VECTOR_SHIFT
;
2163 next
.portv_trunkid
= (val
& mask
) >> shift
;
2170 static int mv88e6xxx_port_db_dump_fid(struct mv88e6xxx_chip
*chip
,
2171 u16 fid
, u16 vid
, int port
,
2172 struct switchdev_obj
*obj
,
2173 int (*cb
)(struct switchdev_obj
*obj
))
2175 struct mv88e6xxx_atu_entry addr
= {
2176 .mac
= { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff },
2180 err
= _mv88e6xxx_atu_mac_write(chip
, addr
.mac
);
2185 err
= _mv88e6xxx_atu_getnext(chip
, fid
, &addr
);
2189 if (addr
.state
== GLOBAL_ATU_DATA_STATE_UNUSED
)
2192 if (addr
.trunk
|| (addr
.portv_trunkid
& BIT(port
)) == 0)
2195 if (obj
->id
== SWITCHDEV_OBJ_ID_PORT_FDB
) {
2196 struct switchdev_obj_port_fdb
*fdb
;
2198 if (!is_unicast_ether_addr(addr
.mac
))
2201 fdb
= SWITCHDEV_OBJ_PORT_FDB(obj
);
2203 ether_addr_copy(fdb
->addr
, addr
.mac
);
2204 if (addr
.state
== GLOBAL_ATU_DATA_STATE_UC_STATIC
)
2205 fdb
->ndm_state
= NUD_NOARP
;
2207 fdb
->ndm_state
= NUD_REACHABLE
;
2208 } else if (obj
->id
== SWITCHDEV_OBJ_ID_PORT_MDB
) {
2209 struct switchdev_obj_port_mdb
*mdb
;
2211 if (!is_multicast_ether_addr(addr
.mac
))
2214 mdb
= SWITCHDEV_OBJ_PORT_MDB(obj
);
2216 ether_addr_copy(mdb
->addr
, addr
.mac
);
2224 } while (!is_broadcast_ether_addr(addr
.mac
));
2229 static int mv88e6xxx_port_db_dump(struct mv88e6xxx_chip
*chip
, int port
,
2230 struct switchdev_obj
*obj
,
2231 int (*cb
)(struct switchdev_obj
*obj
))
2233 struct mv88e6xxx_vtu_entry vlan
= {
2234 .vid
= GLOBAL_VTU_VID_MASK
, /* all ones */
2239 /* Dump port's default Filtering Information Database (VLAN ID 0) */
2240 err
= mv88e6xxx_port_get_fid(chip
, port
, &fid
);
2244 err
= mv88e6xxx_port_db_dump_fid(chip
, fid
, 0, port
, obj
, cb
);
2248 /* Dump VLANs' Filtering Information Databases */
2249 err
= _mv88e6xxx_vtu_vid_write(chip
, vlan
.vid
);
2254 err
= _mv88e6xxx_vtu_getnext(chip
, &vlan
);
2261 err
= mv88e6xxx_port_db_dump_fid(chip
, vlan
.fid
, vlan
.vid
, port
,
2265 } while (vlan
.vid
< GLOBAL_VTU_VID_MASK
);
2270 static int mv88e6xxx_port_fdb_dump(struct dsa_switch
*ds
, int port
,
2271 struct switchdev_obj_port_fdb
*fdb
,
2272 int (*cb
)(struct switchdev_obj
*obj
))
2274 struct mv88e6xxx_chip
*chip
= ds
->priv
;
2277 mutex_lock(&chip
->reg_lock
);
2278 err
= mv88e6xxx_port_db_dump(chip
, port
, &fdb
->obj
, cb
);
2279 mutex_unlock(&chip
->reg_lock
);
2284 static int mv88e6xxx_port_bridge_join(struct dsa_switch
*ds
, int port
,
2285 struct net_device
*bridge
)
2287 struct mv88e6xxx_chip
*chip
= ds
->priv
;
2290 mutex_lock(&chip
->reg_lock
);
2292 /* Assign the bridge and remap each port's VLANTable */
2293 chip
->ports
[port
].bridge_dev
= bridge
;
2295 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); ++i
) {
2296 if (chip
->ports
[i
].bridge_dev
== bridge
) {
2297 err
= _mv88e6xxx_port_based_vlan_map(chip
, i
);
2303 mutex_unlock(&chip
->reg_lock
);
2308 static void mv88e6xxx_port_bridge_leave(struct dsa_switch
*ds
, int port
)
2310 struct mv88e6xxx_chip
*chip
= ds
->priv
;
2311 struct net_device
*bridge
= chip
->ports
[port
].bridge_dev
;
2314 mutex_lock(&chip
->reg_lock
);
2316 /* Unassign the bridge and remap each port's VLANTable */
2317 chip
->ports
[port
].bridge_dev
= NULL
;
2319 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); ++i
)
2320 if (i
== port
|| chip
->ports
[i
].bridge_dev
== bridge
)
2321 if (_mv88e6xxx_port_based_vlan_map(chip
, i
))
2322 netdev_warn(ds
->ports
[i
].netdev
,
2323 "failed to remap\n");
2325 mutex_unlock(&chip
->reg_lock
);
2328 static int mv88e6xxx_software_reset(struct mv88e6xxx_chip
*chip
)
2330 if (chip
->info
->ops
->reset
)
2331 return chip
->info
->ops
->reset(chip
);
2336 static void mv88e6xxx_hardware_reset(struct mv88e6xxx_chip
*chip
)
2338 struct gpio_desc
*gpiod
= chip
->reset
;
2340 /* If there is a GPIO connected to the reset pin, toggle it */
2342 gpiod_set_value_cansleep(gpiod
, 1);
2343 usleep_range(10000, 20000);
2344 gpiod_set_value_cansleep(gpiod
, 0);
2345 usleep_range(10000, 20000);
2349 static int mv88e6xxx_disable_ports(struct mv88e6xxx_chip
*chip
)
2353 /* Set all ports to the Disabled state */
2354 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); i
++) {
2355 err
= mv88e6xxx_port_set_state(chip
, i
,
2356 PORT_CONTROL_STATE_DISABLED
);
2361 /* Wait for transmit queues to drain,
2362 * i.e. 2ms for a maximum frame to be transmitted at 10 Mbps.
2364 usleep_range(2000, 4000);
2369 static int mv88e6xxx_switch_reset(struct mv88e6xxx_chip
*chip
)
2373 err
= mv88e6xxx_disable_ports(chip
);
2377 mv88e6xxx_hardware_reset(chip
);
2379 return mv88e6xxx_software_reset(chip
);
2382 static int mv88e6xxx_serdes_power_on(struct mv88e6xxx_chip
*chip
)
2387 /* Clear Power Down bit */
2388 err
= mv88e6xxx_serdes_read(chip
, MII_BMCR
, &val
);
2392 if (val
& BMCR_PDOWN
) {
2394 err
= mv88e6xxx_serdes_write(chip
, MII_BMCR
, val
);
2400 static int mv88e6xxx_setup_port_dsa(struct mv88e6xxx_chip
*chip
, int port
,
2405 err
= chip
->info
->ops
->port_set_frame_mode(
2406 chip
, port
, MV88E6XXX_FRAME_MODE_DSA
);
2410 return chip
->info
->ops
->port_set_egress_unknowns(
2411 chip
, port
, port
== upstream_port
);
2414 static int mv88e6xxx_setup_port_cpu(struct mv88e6xxx_chip
*chip
, int port
)
2418 switch (chip
->info
->tag_protocol
) {
2419 case DSA_TAG_PROTO_EDSA
:
2420 err
= chip
->info
->ops
->port_set_frame_mode(
2421 chip
, port
, MV88E6XXX_FRAME_MODE_ETHERTYPE
);
2425 err
= mv88e6xxx_port_set_egress_mode(
2426 chip
, port
, PORT_CONTROL_EGRESS_ADD_TAG
);
2430 if (chip
->info
->ops
->port_set_ether_type
)
2431 err
= chip
->info
->ops
->port_set_ether_type(
2432 chip
, port
, ETH_P_EDSA
);
2435 case DSA_TAG_PROTO_DSA
:
2436 err
= chip
->info
->ops
->port_set_frame_mode(
2437 chip
, port
, MV88E6XXX_FRAME_MODE_DSA
);
2441 err
= mv88e6xxx_port_set_egress_mode(
2442 chip
, port
, PORT_CONTROL_EGRESS_UNMODIFIED
);
2451 return chip
->info
->ops
->port_set_egress_unknowns(chip
, port
, true);
2454 static int mv88e6xxx_setup_port_normal(struct mv88e6xxx_chip
*chip
, int port
)
2458 err
= chip
->info
->ops
->port_set_frame_mode(
2459 chip
, port
, MV88E6XXX_FRAME_MODE_NORMAL
);
2463 return chip
->info
->ops
->port_set_egress_unknowns(chip
, port
, false);
2466 static int mv88e6xxx_setup_port(struct mv88e6xxx_chip
*chip
, int port
)
2468 struct dsa_switch
*ds
= chip
->ds
;
2472 /* MAC Forcing register: don't force link, speed, duplex or flow control
2473 * state to any particular values on physical ports, but force the CPU
2474 * port and all DSA ports to their maximum bandwidth and full duplex.
2476 if (dsa_is_cpu_port(ds
, port
) || dsa_is_dsa_port(ds
, port
))
2477 err
= mv88e6xxx_port_setup_mac(chip
, port
, LINK_FORCED_UP
,
2478 SPEED_MAX
, DUPLEX_FULL
,
2479 PHY_INTERFACE_MODE_NA
);
2481 err
= mv88e6xxx_port_setup_mac(chip
, port
, LINK_UNFORCED
,
2482 SPEED_UNFORCED
, DUPLEX_UNFORCED
,
2483 PHY_INTERFACE_MODE_NA
);
2487 /* Port Control: disable Drop-on-Unlock, disable Drop-on-Lock,
2488 * disable Header mode, enable IGMP/MLD snooping, disable VLAN
2489 * tunneling, determine priority by looking at 802.1p and IP
2490 * priority fields (IP prio has precedence), and set STP state
2493 * If this is the CPU link, use DSA or EDSA tagging depending
2494 * on which tagging mode was configured.
2496 * If this is a link to another switch, use DSA tagging mode.
2498 * If this is the upstream port for this switch, enable
2499 * forwarding of unknown unicasts and multicasts.
2501 reg
= PORT_CONTROL_IGMP_MLD_SNOOP
|
2502 PORT_CONTROL_USE_TAG
| PORT_CONTROL_USE_IP
|
2503 PORT_CONTROL_STATE_FORWARDING
;
2504 err
= mv88e6xxx_port_write(chip
, port
, PORT_CONTROL
, reg
);
2508 if (dsa_is_cpu_port(ds
, port
)) {
2509 err
= mv88e6xxx_setup_port_cpu(chip
, port
);
2510 } else if (dsa_is_dsa_port(ds
, port
)) {
2511 err
= mv88e6xxx_setup_port_dsa(chip
, port
,
2512 dsa_upstream_port(ds
));
2514 err
= mv88e6xxx_setup_port_normal(chip
, port
);
2519 /* If this port is connected to a SerDes, make sure the SerDes is not
2522 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAGS_SERDES
)) {
2523 err
= mv88e6xxx_port_read(chip
, port
, PORT_STATUS
, ®
);
2526 reg
&= PORT_STATUS_CMODE_MASK
;
2527 if ((reg
== PORT_STATUS_CMODE_100BASE_X
) ||
2528 (reg
== PORT_STATUS_CMODE_1000BASE_X
) ||
2529 (reg
== PORT_STATUS_CMODE_SGMII
)) {
2530 err
= mv88e6xxx_serdes_power_on(chip
);
2536 /* Port Control 2: don't force a good FCS, set the maximum frame size to
2537 * 10240 bytes, disable 802.1q tags checking, don't discard tagged or
2538 * untagged frames on this port, do a destination address lookup on all
2539 * received packets as usual, disable ARP mirroring and don't send a
2540 * copy of all transmitted/received frames on this port to the CPU.
2543 if (mv88e6xxx_6352_family(chip
) || mv88e6xxx_6351_family(chip
) ||
2544 mv88e6xxx_6165_family(chip
) || mv88e6xxx_6097_family(chip
) ||
2545 mv88e6xxx_6095_family(chip
) || mv88e6xxx_6320_family(chip
) ||
2546 mv88e6xxx_6185_family(chip
))
2547 reg
= PORT_CONTROL_2_MAP_DA
;
2549 if (mv88e6xxx_6095_family(chip
) || mv88e6xxx_6185_family(chip
)) {
2550 /* Set the upstream port this port should use */
2551 reg
|= dsa_upstream_port(ds
);
2552 /* enable forwarding of unknown multicast addresses to
2555 if (port
== dsa_upstream_port(ds
))
2556 reg
|= PORT_CONTROL_2_FORWARD_UNKNOWN
;
2559 reg
|= PORT_CONTROL_2_8021Q_DISABLED
;
2562 err
= mv88e6xxx_port_write(chip
, port
, PORT_CONTROL_2
, reg
);
2567 if (chip
->info
->ops
->port_jumbo_config
) {
2568 err
= chip
->info
->ops
->port_jumbo_config(chip
, port
);
2573 /* Port Association Vector: when learning source addresses
2574 * of packets, add the address to the address database using
2575 * a port bitmap that has only the bit for this port set and
2576 * the other bits clear.
2579 /* Disable learning for CPU port */
2580 if (dsa_is_cpu_port(ds
, port
))
2583 err
= mv88e6xxx_port_write(chip
, port
, PORT_ASSOC_VECTOR
, reg
);
2587 /* Egress rate control 2: disable egress rate control. */
2588 err
= mv88e6xxx_port_write(chip
, port
, PORT_RATE_CONTROL_2
, 0x0000);
2592 if (chip
->info
->ops
->port_pause_config
) {
2593 err
= chip
->info
->ops
->port_pause_config(chip
, port
);
2598 if (mv88e6xxx_6352_family(chip
) || mv88e6xxx_6351_family(chip
) ||
2599 mv88e6xxx_6165_family(chip
) || mv88e6xxx_6097_family(chip
) ||
2600 mv88e6xxx_6320_family(chip
)) {
2601 /* Port ATU control: disable limiting the number of
2602 * address database entries that this port is allowed
2605 err
= mv88e6xxx_port_write(chip
, port
, PORT_ATU_CONTROL
,
2607 /* Priority Override: disable DA, SA and VTU priority
2610 err
= mv88e6xxx_port_write(chip
, port
, PORT_PRI_OVERRIDE
,
2616 if (chip
->info
->ops
->port_tag_remap
) {
2617 err
= chip
->info
->ops
->port_tag_remap(chip
, port
);
2622 if (chip
->info
->ops
->port_egress_rate_limiting
) {
2623 err
= chip
->info
->ops
->port_egress_rate_limiting(chip
, port
);
2628 /* Port Control 1: disable trunking, disable sending
2629 * learning messages to this port.
2631 err
= mv88e6xxx_port_write(chip
, port
, PORT_CONTROL_1
, 0x0000);
2635 /* Port based VLAN map: give each port the same default address
2636 * database, and allow bidirectional communication between the
2637 * CPU and DSA port(s), and the other ports.
2639 err
= mv88e6xxx_port_set_fid(chip
, port
, 0);
2643 err
= _mv88e6xxx_port_based_vlan_map(chip
, port
);
2647 /* Default VLAN ID and priority: don't set a default VLAN
2648 * ID, and set the default packet priority to zero.
2650 return mv88e6xxx_port_write(chip
, port
, PORT_DEFAULT_VLAN
, 0x0000);
2653 static int mv88e6xxx_g1_set_switch_mac(struct mv88e6xxx_chip
*chip
, u8
*addr
)
2657 err
= mv88e6xxx_g1_write(chip
, GLOBAL_MAC_01
, (addr
[0] << 8) | addr
[1]);
2661 err
= mv88e6xxx_g1_write(chip
, GLOBAL_MAC_23
, (addr
[2] << 8) | addr
[3]);
2665 err
= mv88e6xxx_g1_write(chip
, GLOBAL_MAC_45
, (addr
[4] << 8) | addr
[5]);
2672 static int mv88e6xxx_g1_set_age_time(struct mv88e6xxx_chip
*chip
,
2675 const unsigned int coeff
= chip
->info
->age_time_coeff
;
2676 const unsigned int min
= 0x01 * coeff
;
2677 const unsigned int max
= 0xff * coeff
;
2682 if (msecs
< min
|| msecs
> max
)
2685 /* Round to nearest multiple of coeff */
2686 age_time
= (msecs
+ coeff
/ 2) / coeff
;
2688 err
= mv88e6xxx_g1_read(chip
, GLOBAL_ATU_CONTROL
, &val
);
2692 /* AgeTime is 11:4 bits */
2694 val
|= age_time
<< 4;
2696 return mv88e6xxx_g1_write(chip
, GLOBAL_ATU_CONTROL
, val
);
2699 static int mv88e6xxx_set_ageing_time(struct dsa_switch
*ds
,
2700 unsigned int ageing_time
)
2702 struct mv88e6xxx_chip
*chip
= ds
->priv
;
2705 mutex_lock(&chip
->reg_lock
);
2706 err
= mv88e6xxx_g1_set_age_time(chip
, ageing_time
);
2707 mutex_unlock(&chip
->reg_lock
);
2712 static int mv88e6xxx_g1_setup(struct mv88e6xxx_chip
*chip
)
2714 struct dsa_switch
*ds
= chip
->ds
;
2715 u32 upstream_port
= dsa_upstream_port(ds
);
2718 /* Enable the PHY Polling Unit if present, don't discard any packets,
2719 * and mask all interrupt sources.
2721 err
= mv88e6xxx_ppu_enable(chip
);
2725 if (chip
->info
->ops
->g1_set_cpu_port
) {
2726 err
= chip
->info
->ops
->g1_set_cpu_port(chip
, upstream_port
);
2731 if (chip
->info
->ops
->g1_set_egress_port
) {
2732 err
= chip
->info
->ops
->g1_set_egress_port(chip
, upstream_port
);
2737 /* Disable remote management, and set the switch's DSA device number. */
2738 err
= mv88e6xxx_g1_write(chip
, GLOBAL_CONTROL_2
,
2739 GLOBAL_CONTROL_2_MULTIPLE_CASCADE
|
2740 (ds
->index
& 0x1f));
2744 /* Clear all the VTU and STU entries */
2745 err
= _mv88e6xxx_vtu_stu_flush(chip
);
2749 /* Set the default address aging time to 5 minutes, and
2750 * enable address learn messages to be sent to all message
2753 err
= mv88e6xxx_g1_write(chip
, GLOBAL_ATU_CONTROL
,
2754 GLOBAL_ATU_CONTROL_LEARN2ALL
);
2758 err
= mv88e6xxx_g1_set_age_time(chip
, 300000);
2762 /* Clear all ATU entries */
2763 err
= _mv88e6xxx_atu_flush(chip
, 0, true);
2767 /* Configure the IP ToS mapping registers. */
2768 err
= mv88e6xxx_g1_write(chip
, GLOBAL_IP_PRI_0
, 0x0000);
2771 err
= mv88e6xxx_g1_write(chip
, GLOBAL_IP_PRI_1
, 0x0000);
2774 err
= mv88e6xxx_g1_write(chip
, GLOBAL_IP_PRI_2
, 0x5555);
2777 err
= mv88e6xxx_g1_write(chip
, GLOBAL_IP_PRI_3
, 0x5555);
2780 err
= mv88e6xxx_g1_write(chip
, GLOBAL_IP_PRI_4
, 0xaaaa);
2783 err
= mv88e6xxx_g1_write(chip
, GLOBAL_IP_PRI_5
, 0xaaaa);
2786 err
= mv88e6xxx_g1_write(chip
, GLOBAL_IP_PRI_6
, 0xffff);
2789 err
= mv88e6xxx_g1_write(chip
, GLOBAL_IP_PRI_7
, 0xffff);
2793 /* Configure the IEEE 802.1p priority mapping register. */
2794 err
= mv88e6xxx_g1_write(chip
, GLOBAL_IEEE_PRI
, 0xfa41);
2798 /* Initialize the statistics unit */
2799 err
= mv88e6xxx_stats_set_histogram(chip
);
2803 /* Clear the statistics counters for all ports */
2804 err
= mv88e6xxx_g1_write(chip
, GLOBAL_STATS_OP
,
2805 GLOBAL_STATS_OP_FLUSH_ALL
);
2809 /* Wait for the flush to complete. */
2810 err
= mv88e6xxx_g1_stats_wait(chip
);
2817 static int mv88e6xxx_setup(struct dsa_switch
*ds
)
2819 struct mv88e6xxx_chip
*chip
= ds
->priv
;
2824 ds
->slave_mii_bus
= chip
->mdio_bus
;
2826 mutex_lock(&chip
->reg_lock
);
2828 /* Setup Switch Port Registers */
2829 for (i
= 0; i
< mv88e6xxx_num_ports(chip
); i
++) {
2830 err
= mv88e6xxx_setup_port(chip
, i
);
2835 /* Setup Switch Global 1 Registers */
2836 err
= mv88e6xxx_g1_setup(chip
);
2840 /* Setup Switch Global 2 Registers */
2841 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAG_GLOBAL2
)) {
2842 err
= mv88e6xxx_g2_setup(chip
);
2847 /* Some generations have the configuration of sending reserved
2848 * management frames to the CPU in global2, others in
2849 * global1. Hence it does not fit the two setup functions
2852 if (chip
->info
->ops
->mgmt_rsvd2cpu
) {
2853 err
= chip
->info
->ops
->mgmt_rsvd2cpu(chip
);
2859 mutex_unlock(&chip
->reg_lock
);
2864 static int mv88e6xxx_set_addr(struct dsa_switch
*ds
, u8
*addr
)
2866 struct mv88e6xxx_chip
*chip
= ds
->priv
;
2869 if (!chip
->info
->ops
->set_switch_mac
)
2872 mutex_lock(&chip
->reg_lock
);
2873 err
= chip
->info
->ops
->set_switch_mac(chip
, addr
);
2874 mutex_unlock(&chip
->reg_lock
);
2879 static int mv88e6xxx_mdio_read(struct mii_bus
*bus
, int phy
, int reg
)
2881 struct mv88e6xxx_chip
*chip
= bus
->priv
;
2885 if (phy
>= mv88e6xxx_num_ports(chip
))
2888 mutex_lock(&chip
->reg_lock
);
2889 err
= mv88e6xxx_phy_read(chip
, phy
, reg
, &val
);
2890 mutex_unlock(&chip
->reg_lock
);
2892 return err
? err
: val
;
2895 static int mv88e6xxx_mdio_write(struct mii_bus
*bus
, int phy
, int reg
, u16 val
)
2897 struct mv88e6xxx_chip
*chip
= bus
->priv
;
2900 if (phy
>= mv88e6xxx_num_ports(chip
))
2903 mutex_lock(&chip
->reg_lock
);
2904 err
= mv88e6xxx_phy_write(chip
, phy
, reg
, val
);
2905 mutex_unlock(&chip
->reg_lock
);
2910 static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip
*chip
,
2911 struct device_node
*np
)
2914 struct mii_bus
*bus
;
2918 chip
->mdio_np
= of_get_child_by_name(np
, "mdio");
2920 bus
= devm_mdiobus_alloc(chip
->dev
);
2924 bus
->priv
= (void *)chip
;
2926 bus
->name
= np
->full_name
;
2927 snprintf(bus
->id
, MII_BUS_ID_SIZE
, "%s", np
->full_name
);
2929 bus
->name
= "mv88e6xxx SMI";
2930 snprintf(bus
->id
, MII_BUS_ID_SIZE
, "mv88e6xxx-%d", index
++);
2933 bus
->read
= mv88e6xxx_mdio_read
;
2934 bus
->write
= mv88e6xxx_mdio_write
;
2935 bus
->parent
= chip
->dev
;
2938 err
= of_mdiobus_register(bus
, chip
->mdio_np
);
2940 err
= mdiobus_register(bus
);
2942 dev_err(chip
->dev
, "Cannot register MDIO bus (%d)\n", err
);
2945 chip
->mdio_bus
= bus
;
2951 of_node_put(chip
->mdio_np
);
2956 static void mv88e6xxx_mdio_unregister(struct mv88e6xxx_chip
*chip
)
2959 struct mii_bus
*bus
= chip
->mdio_bus
;
2961 mdiobus_unregister(bus
);
2964 of_node_put(chip
->mdio_np
);
2967 #ifdef CONFIG_NET_DSA_HWMON
2969 static int mv88e61xx_get_temp(struct dsa_switch
*ds
, int *temp
)
2971 struct mv88e6xxx_chip
*chip
= ds
->priv
;
2977 mutex_lock(&chip
->reg_lock
);
2979 ret
= mv88e6xxx_phy_write(chip
, 0x0, 0x16, 0x6);
2983 /* Enable temperature sensor */
2984 ret
= mv88e6xxx_phy_read(chip
, 0x0, 0x1a, &val
);
2988 ret
= mv88e6xxx_phy_write(chip
, 0x0, 0x1a, val
| (1 << 5));
2992 /* Wait for temperature to stabilize */
2993 usleep_range(10000, 12000);
2995 ret
= mv88e6xxx_phy_read(chip
, 0x0, 0x1a, &val
);
2999 /* Disable temperature sensor */
3000 ret
= mv88e6xxx_phy_write(chip
, 0x0, 0x1a, val
& ~(1 << 5));
3004 *temp
= ((val
& 0x1f) - 5) * 5;
3007 mv88e6xxx_phy_write(chip
, 0x0, 0x16, 0x0);
3008 mutex_unlock(&chip
->reg_lock
);
3012 static int mv88e63xx_get_temp(struct dsa_switch
*ds
, int *temp
)
3014 struct mv88e6xxx_chip
*chip
= ds
->priv
;
3015 int phy
= mv88e6xxx_6320_family(chip
) ? 3 : 0;
3021 mutex_lock(&chip
->reg_lock
);
3022 ret
= mv88e6xxx_phy_page_read(chip
, phy
, 6, 27, &val
);
3023 mutex_unlock(&chip
->reg_lock
);
3027 *temp
= (val
& 0xff) - 25;
3032 static int mv88e6xxx_get_temp(struct dsa_switch
*ds
, int *temp
)
3034 struct mv88e6xxx_chip
*chip
= ds
->priv
;
3036 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_TEMP
))
3039 if (mv88e6xxx_6320_family(chip
) || mv88e6xxx_6352_family(chip
))
3040 return mv88e63xx_get_temp(ds
, temp
);
3042 return mv88e61xx_get_temp(ds
, temp
);
3045 static int mv88e6xxx_get_temp_limit(struct dsa_switch
*ds
, int *temp
)
3047 struct mv88e6xxx_chip
*chip
= ds
->priv
;
3048 int phy
= mv88e6xxx_6320_family(chip
) ? 3 : 0;
3052 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_TEMP_LIMIT
))
3057 mutex_lock(&chip
->reg_lock
);
3058 ret
= mv88e6xxx_phy_page_read(chip
, phy
, 6, 26, &val
);
3059 mutex_unlock(&chip
->reg_lock
);
3063 *temp
= (((val
>> 8) & 0x1f) * 5) - 25;
3068 static int mv88e6xxx_set_temp_limit(struct dsa_switch
*ds
, int temp
)
3070 struct mv88e6xxx_chip
*chip
= ds
->priv
;
3071 int phy
= mv88e6xxx_6320_family(chip
) ? 3 : 0;
3075 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_TEMP_LIMIT
))
3078 mutex_lock(&chip
->reg_lock
);
3079 err
= mv88e6xxx_phy_page_read(chip
, phy
, 6, 26, &val
);
3082 temp
= clamp_val(DIV_ROUND_CLOSEST(temp
, 5) + 5, 0, 0x1f);
3083 err
= mv88e6xxx_phy_page_write(chip
, phy
, 6, 26,
3084 (val
& 0xe0ff) | (temp
<< 8));
3086 mutex_unlock(&chip
->reg_lock
);
3091 static int mv88e6xxx_get_temp_alarm(struct dsa_switch
*ds
, bool *alarm
)
3093 struct mv88e6xxx_chip
*chip
= ds
->priv
;
3094 int phy
= mv88e6xxx_6320_family(chip
) ? 3 : 0;
3098 if (!mv88e6xxx_has(chip
, MV88E6XXX_FLAG_TEMP_LIMIT
))
3103 mutex_lock(&chip
->reg_lock
);
3104 ret
= mv88e6xxx_phy_page_read(chip
, phy
, 6, 26, &val
);
3105 mutex_unlock(&chip
->reg_lock
);
3109 *alarm
= !!(val
& 0x40);
3113 #endif /* CONFIG_NET_DSA_HWMON */
3115 static int mv88e6xxx_get_eeprom_len(struct dsa_switch
*ds
)
3117 struct mv88e6xxx_chip
*chip
= ds
->priv
;
3119 return chip
->eeprom_len
;
3122 static int mv88e6xxx_get_eeprom(struct dsa_switch
*ds
,
3123 struct ethtool_eeprom
*eeprom
, u8
*data
)
3125 struct mv88e6xxx_chip
*chip
= ds
->priv
;
3128 if (!chip
->info
->ops
->get_eeprom
)
3131 mutex_lock(&chip
->reg_lock
);
3132 err
= chip
->info
->ops
->get_eeprom(chip
, eeprom
, data
);
3133 mutex_unlock(&chip
->reg_lock
);
3138 eeprom
->magic
= 0xc3ec4951;
3143 static int mv88e6xxx_set_eeprom(struct dsa_switch
*ds
,
3144 struct ethtool_eeprom
*eeprom
, u8
*data
)
3146 struct mv88e6xxx_chip
*chip
= ds
->priv
;
3149 if (!chip
->info
->ops
->set_eeprom
)
3152 if (eeprom
->magic
!= 0xc3ec4951)
3155 mutex_lock(&chip
->reg_lock
);
3156 err
= chip
->info
->ops
->set_eeprom(chip
, eeprom
, data
);
3157 mutex_unlock(&chip
->reg_lock
);
3162 static const struct mv88e6xxx_ops mv88e6085_ops
= {
3163 /* MV88E6XXX_FAMILY_6097 */
3164 .set_switch_mac
= mv88e6xxx_g1_set_switch_mac
,
3165 .phy_read
= mv88e6xxx_phy_ppu_read
,
3166 .phy_write
= mv88e6xxx_phy_ppu_write
,
3167 .port_set_link
= mv88e6xxx_port_set_link
,
3168 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3169 .port_set_speed
= mv88e6185_port_set_speed
,
3170 .port_tag_remap
= mv88e6095_port_tag_remap
,
3171 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3172 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3173 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3174 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3175 .port_pause_config
= mv88e6097_port_pause_config
,
3176 .stats_snapshot
= mv88e6xxx_g1_stats_snapshot
,
3177 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3178 .stats_get_strings
= mv88e6095_stats_get_strings
,
3179 .stats_get_stats
= mv88e6095_stats_get_stats
,
3180 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3181 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3182 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3183 .ppu_enable
= mv88e6185_g1_ppu_enable
,
3184 .ppu_disable
= mv88e6185_g1_ppu_disable
,
3185 .reset
= mv88e6185_g1_reset
,
3188 static const struct mv88e6xxx_ops mv88e6095_ops
= {
3189 /* MV88E6XXX_FAMILY_6095 */
3190 .set_switch_mac
= mv88e6xxx_g1_set_switch_mac
,
3191 .phy_read
= mv88e6xxx_phy_ppu_read
,
3192 .phy_write
= mv88e6xxx_phy_ppu_write
,
3193 .port_set_link
= mv88e6xxx_port_set_link
,
3194 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3195 .port_set_speed
= mv88e6185_port_set_speed
,
3196 .port_set_frame_mode
= mv88e6085_port_set_frame_mode
,
3197 .port_set_egress_unknowns
= mv88e6085_port_set_egress_unknowns
,
3198 .stats_snapshot
= mv88e6xxx_g1_stats_snapshot
,
3199 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3200 .stats_get_strings
= mv88e6095_stats_get_strings
,
3201 .stats_get_stats
= mv88e6095_stats_get_stats
,
3202 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3203 .ppu_enable
= mv88e6185_g1_ppu_enable
,
3204 .ppu_disable
= mv88e6185_g1_ppu_disable
,
3205 .reset
= mv88e6185_g1_reset
,
3208 static const struct mv88e6xxx_ops mv88e6097_ops
= {
3209 /* MV88E6XXX_FAMILY_6097 */
3210 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3211 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3212 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3213 .port_set_link
= mv88e6xxx_port_set_link
,
3214 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3215 .port_set_speed
= mv88e6185_port_set_speed
,
3216 .port_tag_remap
= mv88e6095_port_tag_remap
,
3217 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3218 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3219 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3220 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3221 .port_egress_rate_limiting
= mv88e6095_port_egress_rate_limiting
,
3222 .port_pause_config
= mv88e6097_port_pause_config
,
3223 .stats_snapshot
= mv88e6xxx_g1_stats_snapshot
,
3224 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3225 .stats_get_strings
= mv88e6095_stats_get_strings
,
3226 .stats_get_stats
= mv88e6095_stats_get_stats
,
3227 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3228 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3229 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3230 .reset
= mv88e6352_g1_reset
,
3233 static const struct mv88e6xxx_ops mv88e6123_ops
= {
3234 /* MV88E6XXX_FAMILY_6165 */
3235 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3236 .phy_read
= mv88e6xxx_read
,
3237 .phy_write
= mv88e6xxx_write
,
3238 .port_set_link
= mv88e6xxx_port_set_link
,
3239 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3240 .port_set_speed
= mv88e6185_port_set_speed
,
3241 .port_set_frame_mode
= mv88e6085_port_set_frame_mode
,
3242 .port_set_egress_unknowns
= mv88e6085_port_set_egress_unknowns
,
3243 .stats_snapshot
= mv88e6xxx_g1_stats_snapshot
,
3244 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3245 .stats_get_strings
= mv88e6095_stats_get_strings
,
3246 .stats_get_stats
= mv88e6095_stats_get_stats
,
3247 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3248 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3249 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3250 .reset
= mv88e6352_g1_reset
,
3253 static const struct mv88e6xxx_ops mv88e6131_ops
= {
3254 /* MV88E6XXX_FAMILY_6185 */
3255 .set_switch_mac
= mv88e6xxx_g1_set_switch_mac
,
3256 .phy_read
= mv88e6xxx_phy_ppu_read
,
3257 .phy_write
= mv88e6xxx_phy_ppu_write
,
3258 .port_set_link
= mv88e6xxx_port_set_link
,
3259 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3260 .port_set_speed
= mv88e6185_port_set_speed
,
3261 .port_tag_remap
= mv88e6095_port_tag_remap
,
3262 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3263 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3264 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3265 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3266 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3267 .port_pause_config
= mv88e6097_port_pause_config
,
3268 .stats_snapshot
= mv88e6xxx_g1_stats_snapshot
,
3269 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3270 .stats_get_strings
= mv88e6095_stats_get_strings
,
3271 .stats_get_stats
= mv88e6095_stats_get_stats
,
3272 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3273 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3274 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3275 .ppu_enable
= mv88e6185_g1_ppu_enable
,
3276 .ppu_disable
= mv88e6185_g1_ppu_disable
,
3277 .reset
= mv88e6185_g1_reset
,
3280 static const struct mv88e6xxx_ops mv88e6161_ops
= {
3281 /* MV88E6XXX_FAMILY_6165 */
3282 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3283 .phy_read
= mv88e6xxx_read
,
3284 .phy_write
= mv88e6xxx_write
,
3285 .port_set_link
= mv88e6xxx_port_set_link
,
3286 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3287 .port_set_speed
= mv88e6185_port_set_speed
,
3288 .port_tag_remap
= mv88e6095_port_tag_remap
,
3289 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3290 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3291 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3292 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3293 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3294 .port_pause_config
= mv88e6097_port_pause_config
,
3295 .stats_snapshot
= mv88e6xxx_g1_stats_snapshot
,
3296 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3297 .stats_get_strings
= mv88e6095_stats_get_strings
,
3298 .stats_get_stats
= mv88e6095_stats_get_stats
,
3299 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3300 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3301 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3302 .reset
= mv88e6352_g1_reset
,
3305 static const struct mv88e6xxx_ops mv88e6165_ops
= {
3306 /* MV88E6XXX_FAMILY_6165 */
3307 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3308 .phy_read
= mv88e6xxx_read
,
3309 .phy_write
= mv88e6xxx_write
,
3310 .port_set_link
= mv88e6xxx_port_set_link
,
3311 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3312 .port_set_speed
= mv88e6185_port_set_speed
,
3313 .stats_snapshot
= mv88e6xxx_g1_stats_snapshot
,
3314 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3315 .stats_get_strings
= mv88e6095_stats_get_strings
,
3316 .stats_get_stats
= mv88e6095_stats_get_stats
,
3317 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3318 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3319 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3320 .reset
= mv88e6352_g1_reset
,
3323 static const struct mv88e6xxx_ops mv88e6171_ops
= {
3324 /* MV88E6XXX_FAMILY_6351 */
3325 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3326 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3327 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3328 .port_set_link
= mv88e6xxx_port_set_link
,
3329 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3330 .port_set_rgmii_delay
= mv88e6352_port_set_rgmii_delay
,
3331 .port_set_speed
= mv88e6185_port_set_speed
,
3332 .port_tag_remap
= mv88e6095_port_tag_remap
,
3333 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3334 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3335 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3336 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3337 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3338 .port_pause_config
= mv88e6097_port_pause_config
,
3339 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3340 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3341 .stats_get_strings
= mv88e6095_stats_get_strings
,
3342 .stats_get_stats
= mv88e6095_stats_get_stats
,
3343 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3344 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3345 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3346 .reset
= mv88e6352_g1_reset
,
3349 static const struct mv88e6xxx_ops mv88e6172_ops
= {
3350 /* MV88E6XXX_FAMILY_6352 */
3351 .get_eeprom
= mv88e6xxx_g2_get_eeprom16
,
3352 .set_eeprom
= mv88e6xxx_g2_set_eeprom16
,
3353 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3354 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3355 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3356 .port_set_link
= mv88e6xxx_port_set_link
,
3357 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3358 .port_set_rgmii_delay
= mv88e6352_port_set_rgmii_delay
,
3359 .port_set_speed
= mv88e6352_port_set_speed
,
3360 .port_tag_remap
= mv88e6095_port_tag_remap
,
3361 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3362 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3363 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3364 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3365 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3366 .port_pause_config
= mv88e6097_port_pause_config
,
3367 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3368 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3369 .stats_get_strings
= mv88e6095_stats_get_strings
,
3370 .stats_get_stats
= mv88e6095_stats_get_stats
,
3371 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3372 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3373 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3374 .reset
= mv88e6352_g1_reset
,
3377 static const struct mv88e6xxx_ops mv88e6175_ops
= {
3378 /* MV88E6XXX_FAMILY_6351 */
3379 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3380 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3381 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3382 .port_set_link
= mv88e6xxx_port_set_link
,
3383 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3384 .port_set_rgmii_delay
= mv88e6352_port_set_rgmii_delay
,
3385 .port_set_speed
= mv88e6185_port_set_speed
,
3386 .port_tag_remap
= mv88e6095_port_tag_remap
,
3387 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3388 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3389 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3390 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3391 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3392 .port_pause_config
= mv88e6097_port_pause_config
,
3393 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3394 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3395 .stats_get_strings
= mv88e6095_stats_get_strings
,
3396 .stats_get_stats
= mv88e6095_stats_get_stats
,
3397 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3398 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3399 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3400 .reset
= mv88e6352_g1_reset
,
3403 static const struct mv88e6xxx_ops mv88e6176_ops
= {
3404 /* MV88E6XXX_FAMILY_6352 */
3405 .get_eeprom
= mv88e6xxx_g2_get_eeprom16
,
3406 .set_eeprom
= mv88e6xxx_g2_set_eeprom16
,
3407 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3408 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3409 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3410 .port_set_link
= mv88e6xxx_port_set_link
,
3411 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3412 .port_set_rgmii_delay
= mv88e6352_port_set_rgmii_delay
,
3413 .port_set_speed
= mv88e6352_port_set_speed
,
3414 .port_tag_remap
= mv88e6095_port_tag_remap
,
3415 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3416 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3417 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3418 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3419 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3420 .port_pause_config
= mv88e6097_port_pause_config
,
3421 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3422 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3423 .stats_get_strings
= mv88e6095_stats_get_strings
,
3424 .stats_get_stats
= mv88e6095_stats_get_stats
,
3425 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3426 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3427 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3428 .reset
= mv88e6352_g1_reset
,
3431 static const struct mv88e6xxx_ops mv88e6185_ops
= {
3432 /* MV88E6XXX_FAMILY_6185 */
3433 .set_switch_mac
= mv88e6xxx_g1_set_switch_mac
,
3434 .phy_read
= mv88e6xxx_phy_ppu_read
,
3435 .phy_write
= mv88e6xxx_phy_ppu_write
,
3436 .port_set_link
= mv88e6xxx_port_set_link
,
3437 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3438 .port_set_speed
= mv88e6185_port_set_speed
,
3439 .port_set_frame_mode
= mv88e6085_port_set_frame_mode
,
3440 .port_set_egress_unknowns
= mv88e6085_port_set_egress_unknowns
,
3441 .port_egress_rate_limiting
= mv88e6095_port_egress_rate_limiting
,
3442 .stats_snapshot
= mv88e6xxx_g1_stats_snapshot
,
3443 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3444 .stats_get_strings
= mv88e6095_stats_get_strings
,
3445 .stats_get_stats
= mv88e6095_stats_get_stats
,
3446 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3447 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3448 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3449 .ppu_enable
= mv88e6185_g1_ppu_enable
,
3450 .ppu_disable
= mv88e6185_g1_ppu_disable
,
3451 .reset
= mv88e6185_g1_reset
,
3454 static const struct mv88e6xxx_ops mv88e6190_ops
= {
3455 /* MV88E6XXX_FAMILY_6390 */
3456 .get_eeprom
= mv88e6xxx_g2_get_eeprom8
,
3457 .set_eeprom
= mv88e6xxx_g2_set_eeprom8
,
3458 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3459 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3460 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3461 .port_set_link
= mv88e6xxx_port_set_link
,
3462 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3463 .port_set_rgmii_delay
= mv88e6390_port_set_rgmii_delay
,
3464 .port_set_speed
= mv88e6390_port_set_speed
,
3465 .port_tag_remap
= mv88e6390_port_tag_remap
,
3466 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3467 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3468 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3469 .port_pause_config
= mv88e6390_port_pause_config
,
3470 .stats_snapshot
= mv88e6390_g1_stats_snapshot
,
3471 .stats_set_histogram
= mv88e6390_g1_stats_set_histogram
,
3472 .stats_get_sset_count
= mv88e6320_stats_get_sset_count
,
3473 .stats_get_strings
= mv88e6320_stats_get_strings
,
3474 .stats_get_stats
= mv88e6390_stats_get_stats
,
3475 .g1_set_cpu_port
= mv88e6390_g1_set_cpu_port
,
3476 .g1_set_egress_port
= mv88e6390_g1_set_egress_port
,
3477 .mgmt_rsvd2cpu
= mv88e6390_g1_mgmt_rsvd2cpu
,
3478 .reset
= mv88e6352_g1_reset
,
3481 static const struct mv88e6xxx_ops mv88e6190x_ops
= {
3482 /* MV88E6XXX_FAMILY_6390 */
3483 .get_eeprom
= mv88e6xxx_g2_get_eeprom8
,
3484 .set_eeprom
= mv88e6xxx_g2_set_eeprom8
,
3485 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3486 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3487 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3488 .port_set_link
= mv88e6xxx_port_set_link
,
3489 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3490 .port_set_rgmii_delay
= mv88e6390_port_set_rgmii_delay
,
3491 .port_set_speed
= mv88e6390x_port_set_speed
,
3492 .port_tag_remap
= mv88e6390_port_tag_remap
,
3493 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3494 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3495 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3496 .port_pause_config
= mv88e6390_port_pause_config
,
3497 .stats_snapshot
= mv88e6390_g1_stats_snapshot
,
3498 .stats_set_histogram
= mv88e6390_g1_stats_set_histogram
,
3499 .stats_get_sset_count
= mv88e6320_stats_get_sset_count
,
3500 .stats_get_strings
= mv88e6320_stats_get_strings
,
3501 .stats_get_stats
= mv88e6390_stats_get_stats
,
3502 .g1_set_cpu_port
= mv88e6390_g1_set_cpu_port
,
3503 .g1_set_egress_port
= mv88e6390_g1_set_egress_port
,
3504 .mgmt_rsvd2cpu
= mv88e6390_g1_mgmt_rsvd2cpu
,
3505 .reset
= mv88e6352_g1_reset
,
3508 static const struct mv88e6xxx_ops mv88e6191_ops
= {
3509 /* MV88E6XXX_FAMILY_6390 */
3510 .get_eeprom
= mv88e6xxx_g2_get_eeprom8
,
3511 .set_eeprom
= mv88e6xxx_g2_set_eeprom8
,
3512 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3513 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3514 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3515 .port_set_link
= mv88e6xxx_port_set_link
,
3516 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3517 .port_set_rgmii_delay
= mv88e6390_port_set_rgmii_delay
,
3518 .port_set_speed
= mv88e6390_port_set_speed
,
3519 .port_tag_remap
= mv88e6390_port_tag_remap
,
3520 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3521 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3522 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3523 .port_pause_config
= mv88e6390_port_pause_config
,
3524 .stats_snapshot
= mv88e6390_g1_stats_snapshot
,
3525 .stats_set_histogram
= mv88e6390_g1_stats_set_histogram
,
3526 .stats_get_sset_count
= mv88e6320_stats_get_sset_count
,
3527 .stats_get_strings
= mv88e6320_stats_get_strings
,
3528 .stats_get_stats
= mv88e6390_stats_get_stats
,
3529 .g1_set_cpu_port
= mv88e6390_g1_set_cpu_port
,
3530 .g1_set_egress_port
= mv88e6390_g1_set_egress_port
,
3531 .mgmt_rsvd2cpu
= mv88e6390_g1_mgmt_rsvd2cpu
,
3532 .reset
= mv88e6352_g1_reset
,
3535 static const struct mv88e6xxx_ops mv88e6240_ops
= {
3536 /* MV88E6XXX_FAMILY_6352 */
3537 .get_eeprom
= mv88e6xxx_g2_get_eeprom16
,
3538 .set_eeprom
= mv88e6xxx_g2_set_eeprom16
,
3539 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3540 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3541 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3542 .port_set_link
= mv88e6xxx_port_set_link
,
3543 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3544 .port_set_rgmii_delay
= mv88e6352_port_set_rgmii_delay
,
3545 .port_set_speed
= mv88e6352_port_set_speed
,
3546 .port_tag_remap
= mv88e6095_port_tag_remap
,
3547 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3548 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3549 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3550 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3551 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3552 .port_pause_config
= mv88e6097_port_pause_config
,
3553 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3554 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3555 .stats_get_strings
= mv88e6095_stats_get_strings
,
3556 .stats_get_stats
= mv88e6095_stats_get_stats
,
3557 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3558 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3559 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3560 .reset
= mv88e6352_g1_reset
,
3563 static const struct mv88e6xxx_ops mv88e6290_ops
= {
3564 /* MV88E6XXX_FAMILY_6390 */
3565 .get_eeprom
= mv88e6xxx_g2_get_eeprom8
,
3566 .set_eeprom
= mv88e6xxx_g2_set_eeprom8
,
3567 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3568 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3569 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3570 .port_set_link
= mv88e6xxx_port_set_link
,
3571 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3572 .port_set_rgmii_delay
= mv88e6390_port_set_rgmii_delay
,
3573 .port_set_speed
= mv88e6390_port_set_speed
,
3574 .port_tag_remap
= mv88e6390_port_tag_remap
,
3575 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3576 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3577 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3578 .port_pause_config
= mv88e6390_port_pause_config
,
3579 .stats_snapshot
= mv88e6390_g1_stats_snapshot
,
3580 .stats_set_histogram
= mv88e6390_g1_stats_set_histogram
,
3581 .stats_get_sset_count
= mv88e6320_stats_get_sset_count
,
3582 .stats_get_strings
= mv88e6320_stats_get_strings
,
3583 .stats_get_stats
= mv88e6390_stats_get_stats
,
3584 .g1_set_cpu_port
= mv88e6390_g1_set_cpu_port
,
3585 .g1_set_egress_port
= mv88e6390_g1_set_egress_port
,
3586 .mgmt_rsvd2cpu
= mv88e6390_g1_mgmt_rsvd2cpu
,
3587 .reset
= mv88e6352_g1_reset
,
3590 static const struct mv88e6xxx_ops mv88e6320_ops
= {
3591 /* MV88E6XXX_FAMILY_6320 */
3592 .get_eeprom
= mv88e6xxx_g2_get_eeprom16
,
3593 .set_eeprom
= mv88e6xxx_g2_set_eeprom16
,
3594 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3595 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3596 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3597 .port_set_link
= mv88e6xxx_port_set_link
,
3598 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3599 .port_set_speed
= mv88e6185_port_set_speed
,
3600 .port_tag_remap
= mv88e6095_port_tag_remap
,
3601 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3602 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3603 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3604 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3605 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3606 .port_pause_config
= mv88e6097_port_pause_config
,
3607 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3608 .stats_get_sset_count
= mv88e6320_stats_get_sset_count
,
3609 .stats_get_strings
= mv88e6320_stats_get_strings
,
3610 .stats_get_stats
= mv88e6320_stats_get_stats
,
3611 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3612 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3613 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3614 .reset
= mv88e6352_g1_reset
,
3617 static const struct mv88e6xxx_ops mv88e6321_ops
= {
3618 /* MV88E6XXX_FAMILY_6321 */
3619 .get_eeprom
= mv88e6xxx_g2_get_eeprom16
,
3620 .set_eeprom
= mv88e6xxx_g2_set_eeprom16
,
3621 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3622 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3623 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3624 .port_set_link
= mv88e6xxx_port_set_link
,
3625 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3626 .port_set_speed
= mv88e6185_port_set_speed
,
3627 .port_tag_remap
= mv88e6095_port_tag_remap
,
3628 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3629 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3630 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3631 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3632 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3633 .port_pause_config
= mv88e6097_port_pause_config
,
3634 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3635 .stats_get_sset_count
= mv88e6320_stats_get_sset_count
,
3636 .stats_get_strings
= mv88e6320_stats_get_strings
,
3637 .stats_get_stats
= mv88e6320_stats_get_stats
,
3638 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3639 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3640 .reset
= mv88e6352_g1_reset
,
3643 static const struct mv88e6xxx_ops mv88e6350_ops
= {
3644 /* MV88E6XXX_FAMILY_6351 */
3645 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3646 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3647 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3648 .port_set_link
= mv88e6xxx_port_set_link
,
3649 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3650 .port_set_rgmii_delay
= mv88e6352_port_set_rgmii_delay
,
3651 .port_set_speed
= mv88e6185_port_set_speed
,
3652 .port_tag_remap
= mv88e6095_port_tag_remap
,
3653 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3654 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3655 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3656 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3657 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3658 .port_pause_config
= mv88e6097_port_pause_config
,
3659 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3660 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3661 .stats_get_strings
= mv88e6095_stats_get_strings
,
3662 .stats_get_stats
= mv88e6095_stats_get_stats
,
3663 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3664 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3665 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3666 .reset
= mv88e6352_g1_reset
,
3669 static const struct mv88e6xxx_ops mv88e6351_ops
= {
3670 /* MV88E6XXX_FAMILY_6351 */
3671 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3672 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3673 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3674 .port_set_link
= mv88e6xxx_port_set_link
,
3675 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3676 .port_set_rgmii_delay
= mv88e6352_port_set_rgmii_delay
,
3677 .port_set_speed
= mv88e6185_port_set_speed
,
3678 .port_tag_remap
= mv88e6095_port_tag_remap
,
3679 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3680 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3681 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3682 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3683 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3684 .port_pause_config
= mv88e6097_port_pause_config
,
3685 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3686 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3687 .stats_get_strings
= mv88e6095_stats_get_strings
,
3688 .stats_get_stats
= mv88e6095_stats_get_stats
,
3689 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3690 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3691 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3692 .reset
= mv88e6352_g1_reset
,
3695 static const struct mv88e6xxx_ops mv88e6352_ops
= {
3696 /* MV88E6XXX_FAMILY_6352 */
3697 .get_eeprom
= mv88e6xxx_g2_get_eeprom16
,
3698 .set_eeprom
= mv88e6xxx_g2_set_eeprom16
,
3699 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3700 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3701 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3702 .port_set_link
= mv88e6xxx_port_set_link
,
3703 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3704 .port_set_rgmii_delay
= mv88e6352_port_set_rgmii_delay
,
3705 .port_set_speed
= mv88e6352_port_set_speed
,
3706 .port_tag_remap
= mv88e6095_port_tag_remap
,
3707 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3708 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3709 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3710 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3711 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3712 .port_pause_config
= mv88e6097_port_pause_config
,
3713 .stats_snapshot
= mv88e6320_g1_stats_snapshot
,
3714 .stats_get_sset_count
= mv88e6095_stats_get_sset_count
,
3715 .stats_get_strings
= mv88e6095_stats_get_strings
,
3716 .stats_get_stats
= mv88e6095_stats_get_stats
,
3717 .g1_set_cpu_port
= mv88e6095_g1_set_cpu_port
,
3718 .g1_set_egress_port
= mv88e6095_g1_set_egress_port
,
3719 .mgmt_rsvd2cpu
= mv88e6095_g2_mgmt_rsvd2cpu
,
3720 .reset
= mv88e6352_g1_reset
,
3723 static const struct mv88e6xxx_ops mv88e6390_ops
= {
3724 /* MV88E6XXX_FAMILY_6390 */
3725 .get_eeprom
= mv88e6xxx_g2_get_eeprom8
,
3726 .set_eeprom
= mv88e6xxx_g2_set_eeprom8
,
3727 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3728 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3729 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3730 .port_set_link
= mv88e6xxx_port_set_link
,
3731 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3732 .port_set_rgmii_delay
= mv88e6390_port_set_rgmii_delay
,
3733 .port_set_speed
= mv88e6390_port_set_speed
,
3734 .port_tag_remap
= mv88e6390_port_tag_remap
,
3735 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3736 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3737 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3738 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3739 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3740 .port_pause_config
= mv88e6390_port_pause_config
,
3741 .stats_snapshot
= mv88e6390_g1_stats_snapshot
,
3742 .stats_set_histogram
= mv88e6390_g1_stats_set_histogram
,
3743 .stats_get_sset_count
= mv88e6320_stats_get_sset_count
,
3744 .stats_get_strings
= mv88e6320_stats_get_strings
,
3745 .stats_get_stats
= mv88e6390_stats_get_stats
,
3746 .g1_set_cpu_port
= mv88e6390_g1_set_cpu_port
,
3747 .g1_set_egress_port
= mv88e6390_g1_set_egress_port
,
3748 .mgmt_rsvd2cpu
= mv88e6390_g1_mgmt_rsvd2cpu
,
3749 .reset
= mv88e6352_g1_reset
,
3752 static const struct mv88e6xxx_ops mv88e6390x_ops
= {
3753 /* MV88E6XXX_FAMILY_6390 */
3754 .get_eeprom
= mv88e6xxx_g2_get_eeprom8
,
3755 .set_eeprom
= mv88e6xxx_g2_set_eeprom8
,
3756 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3757 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3758 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3759 .port_set_link
= mv88e6xxx_port_set_link
,
3760 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3761 .port_set_rgmii_delay
= mv88e6390_port_set_rgmii_delay
,
3762 .port_set_speed
= mv88e6390x_port_set_speed
,
3763 .port_tag_remap
= mv88e6390_port_tag_remap
,
3764 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3765 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3766 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3767 .port_jumbo_config
= mv88e6165_port_jumbo_config
,
3768 .port_egress_rate_limiting
= mv88e6097_port_egress_rate_limiting
,
3769 .port_pause_config
= mv88e6390_port_pause_config
,
3770 .stats_snapshot
= mv88e6390_g1_stats_snapshot
,
3771 .stats_set_histogram
= mv88e6390_g1_stats_set_histogram
,
3772 .stats_get_sset_count
= mv88e6320_stats_get_sset_count
,
3773 .stats_get_strings
= mv88e6320_stats_get_strings
,
3774 .stats_get_stats
= mv88e6390_stats_get_stats
,
3775 .g1_set_cpu_port
= mv88e6390_g1_set_cpu_port
,
3776 .g1_set_egress_port
= mv88e6390_g1_set_egress_port
,
3777 .mgmt_rsvd2cpu
= mv88e6390_g1_mgmt_rsvd2cpu
,
3778 .reset
= mv88e6352_g1_reset
,
3781 static const struct mv88e6xxx_ops mv88e6391_ops
= {
3782 /* MV88E6XXX_FAMILY_6390 */
3783 .get_eeprom
= mv88e6xxx_g2_get_eeprom8
,
3784 .set_eeprom
= mv88e6xxx_g2_set_eeprom8
,
3785 .set_switch_mac
= mv88e6xxx_g2_set_switch_mac
,
3786 .phy_read
= mv88e6xxx_g2_smi_phy_read
,
3787 .phy_write
= mv88e6xxx_g2_smi_phy_write
,
3788 .port_set_link
= mv88e6xxx_port_set_link
,
3789 .port_set_duplex
= mv88e6xxx_port_set_duplex
,
3790 .port_set_rgmii_delay
= mv88e6390_port_set_rgmii_delay
,
3791 .port_set_speed
= mv88e6390_port_set_speed
,
3792 .port_tag_remap
= mv88e6390_port_tag_remap
,
3793 .port_set_frame_mode
= mv88e6351_port_set_frame_mode
,
3794 .port_set_egress_unknowns
= mv88e6351_port_set_egress_unknowns
,
3795 .port_set_ether_type
= mv88e6351_port_set_ether_type
,
3796 .port_pause_config
= mv88e6390_port_pause_config
,
3797 .stats_snapshot
= mv88e6390_g1_stats_snapshot
,
3798 .stats_set_histogram
= mv88e6390_g1_stats_set_histogram
,
3799 .stats_get_sset_count
= mv88e6320_stats_get_sset_count
,
3800 .stats_get_strings
= mv88e6320_stats_get_strings
,
3801 .stats_get_stats
= mv88e6390_stats_get_stats
,
3802 .g1_set_cpu_port
= mv88e6390_g1_set_cpu_port
,
3803 .g1_set_egress_port
= mv88e6390_g1_set_egress_port
,
3804 .mgmt_rsvd2cpu
= mv88e6390_g1_mgmt_rsvd2cpu
,
3805 .reset
= mv88e6352_g1_reset
,
3808 static int mv88e6xxx_verify_madatory_ops(struct mv88e6xxx_chip
*chip
,
3809 const struct mv88e6xxx_ops
*ops
)
3811 if (!ops
->port_set_frame_mode
) {
3812 dev_err(chip
->dev
, "Missing port_set_frame_mode");
3816 if (!ops
->port_set_egress_unknowns
) {
3817 dev_err(chip
->dev
, "Missing port_set_egress_mode");
3824 static const struct mv88e6xxx_info mv88e6xxx_table
[] = {
3826 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6085
,
3827 .family
= MV88E6XXX_FAMILY_6097
,
3828 .name
= "Marvell 88E6085",
3829 .num_databases
= 4096,
3831 .port_base_addr
= 0x10,
3832 .global1_addr
= 0x1b,
3833 .age_time_coeff
= 15000,
3835 .tag_protocol
= DSA_TAG_PROTO_DSA
,
3836 .flags
= MV88E6XXX_FLAGS_FAMILY_6097
,
3837 .ops
= &mv88e6085_ops
,
3841 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6095
,
3842 .family
= MV88E6XXX_FAMILY_6095
,
3843 .name
= "Marvell 88E6095/88E6095F",
3844 .num_databases
= 256,
3846 .port_base_addr
= 0x10,
3847 .global1_addr
= 0x1b,
3848 .age_time_coeff
= 15000,
3850 .tag_protocol
= DSA_TAG_PROTO_DSA
,
3851 .flags
= MV88E6XXX_FLAGS_FAMILY_6095
,
3852 .ops
= &mv88e6095_ops
,
3856 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6097
,
3857 .family
= MV88E6XXX_FAMILY_6097
,
3858 .name
= "Marvell 88E6097/88E6097F",
3859 .num_databases
= 4096,
3861 .port_base_addr
= 0x10,
3862 .global1_addr
= 0x1b,
3863 .age_time_coeff
= 15000,
3865 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
3866 .flags
= MV88E6XXX_FLAGS_FAMILY_6097
,
3867 .ops
= &mv88e6097_ops
,
3871 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6123
,
3872 .family
= MV88E6XXX_FAMILY_6165
,
3873 .name
= "Marvell 88E6123",
3874 .num_databases
= 4096,
3876 .port_base_addr
= 0x10,
3877 .global1_addr
= 0x1b,
3878 .age_time_coeff
= 15000,
3880 .tag_protocol
= DSA_TAG_PROTO_DSA
,
3881 .flags
= MV88E6XXX_FLAGS_FAMILY_6165
,
3882 .ops
= &mv88e6123_ops
,
3886 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6131
,
3887 .family
= MV88E6XXX_FAMILY_6185
,
3888 .name
= "Marvell 88E6131",
3889 .num_databases
= 256,
3891 .port_base_addr
= 0x10,
3892 .global1_addr
= 0x1b,
3893 .age_time_coeff
= 15000,
3895 .tag_protocol
= DSA_TAG_PROTO_DSA
,
3896 .flags
= MV88E6XXX_FLAGS_FAMILY_6185
,
3897 .ops
= &mv88e6131_ops
,
3901 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6161
,
3902 .family
= MV88E6XXX_FAMILY_6165
,
3903 .name
= "Marvell 88E6161",
3904 .num_databases
= 4096,
3906 .port_base_addr
= 0x10,
3907 .global1_addr
= 0x1b,
3908 .age_time_coeff
= 15000,
3910 .tag_protocol
= DSA_TAG_PROTO_DSA
,
3911 .flags
= MV88E6XXX_FLAGS_FAMILY_6165
,
3912 .ops
= &mv88e6161_ops
,
3916 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6165
,
3917 .family
= MV88E6XXX_FAMILY_6165
,
3918 .name
= "Marvell 88E6165",
3919 .num_databases
= 4096,
3921 .port_base_addr
= 0x10,
3922 .global1_addr
= 0x1b,
3923 .age_time_coeff
= 15000,
3925 .tag_protocol
= DSA_TAG_PROTO_DSA
,
3926 .flags
= MV88E6XXX_FLAGS_FAMILY_6165
,
3927 .ops
= &mv88e6165_ops
,
3931 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6171
,
3932 .family
= MV88E6XXX_FAMILY_6351
,
3933 .name
= "Marvell 88E6171",
3934 .num_databases
= 4096,
3936 .port_base_addr
= 0x10,
3937 .global1_addr
= 0x1b,
3938 .age_time_coeff
= 15000,
3940 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
3941 .flags
= MV88E6XXX_FLAGS_FAMILY_6351
,
3942 .ops
= &mv88e6171_ops
,
3946 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6172
,
3947 .family
= MV88E6XXX_FAMILY_6352
,
3948 .name
= "Marvell 88E6172",
3949 .num_databases
= 4096,
3951 .port_base_addr
= 0x10,
3952 .global1_addr
= 0x1b,
3953 .age_time_coeff
= 15000,
3955 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
3956 .flags
= MV88E6XXX_FLAGS_FAMILY_6352
,
3957 .ops
= &mv88e6172_ops
,
3961 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6175
,
3962 .family
= MV88E6XXX_FAMILY_6351
,
3963 .name
= "Marvell 88E6175",
3964 .num_databases
= 4096,
3966 .port_base_addr
= 0x10,
3967 .global1_addr
= 0x1b,
3968 .age_time_coeff
= 15000,
3970 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
3971 .flags
= MV88E6XXX_FLAGS_FAMILY_6351
,
3972 .ops
= &mv88e6175_ops
,
3976 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6176
,
3977 .family
= MV88E6XXX_FAMILY_6352
,
3978 .name
= "Marvell 88E6176",
3979 .num_databases
= 4096,
3981 .port_base_addr
= 0x10,
3982 .global1_addr
= 0x1b,
3983 .age_time_coeff
= 15000,
3985 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
3986 .flags
= MV88E6XXX_FLAGS_FAMILY_6352
,
3987 .ops
= &mv88e6176_ops
,
3991 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6185
,
3992 .family
= MV88E6XXX_FAMILY_6185
,
3993 .name
= "Marvell 88E6185",
3994 .num_databases
= 256,
3996 .port_base_addr
= 0x10,
3997 .global1_addr
= 0x1b,
3998 .age_time_coeff
= 15000,
4000 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
4001 .flags
= MV88E6XXX_FLAGS_FAMILY_6185
,
4002 .ops
= &mv88e6185_ops
,
4006 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6190
,
4007 .family
= MV88E6XXX_FAMILY_6390
,
4008 .name
= "Marvell 88E6190",
4009 .num_databases
= 4096,
4010 .num_ports
= 11, /* 10 + Z80 */
4011 .port_base_addr
= 0x0,
4012 .global1_addr
= 0x1b,
4013 .tag_protocol
= DSA_TAG_PROTO_DSA
,
4014 .age_time_coeff
= 15000,
4016 .flags
= MV88E6XXX_FLAGS_FAMILY_6390
,
4017 .ops
= &mv88e6190_ops
,
4021 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6190X
,
4022 .family
= MV88E6XXX_FAMILY_6390
,
4023 .name
= "Marvell 88E6190X",
4024 .num_databases
= 4096,
4025 .num_ports
= 11, /* 10 + Z80 */
4026 .port_base_addr
= 0x0,
4027 .global1_addr
= 0x1b,
4028 .age_time_coeff
= 15000,
4030 .tag_protocol
= DSA_TAG_PROTO_DSA
,
4031 .flags
= MV88E6XXX_FLAGS_FAMILY_6390
,
4032 .ops
= &mv88e6190x_ops
,
4036 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6191
,
4037 .family
= MV88E6XXX_FAMILY_6390
,
4038 .name
= "Marvell 88E6191",
4039 .num_databases
= 4096,
4040 .num_ports
= 11, /* 10 + Z80 */
4041 .port_base_addr
= 0x0,
4042 .global1_addr
= 0x1b,
4043 .age_time_coeff
= 15000,
4045 .tag_protocol
= DSA_TAG_PROTO_DSA
,
4046 .flags
= MV88E6XXX_FLAGS_FAMILY_6390
,
4047 .ops
= &mv88e6391_ops
,
4051 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6240
,
4052 .family
= MV88E6XXX_FAMILY_6352
,
4053 .name
= "Marvell 88E6240",
4054 .num_databases
= 4096,
4056 .port_base_addr
= 0x10,
4057 .global1_addr
= 0x1b,
4058 .age_time_coeff
= 15000,
4060 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
4061 .flags
= MV88E6XXX_FLAGS_FAMILY_6352
,
4062 .ops
= &mv88e6240_ops
,
4066 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6290
,
4067 .family
= MV88E6XXX_FAMILY_6390
,
4068 .name
= "Marvell 88E6290",
4069 .num_databases
= 4096,
4070 .num_ports
= 11, /* 10 + Z80 */
4071 .port_base_addr
= 0x0,
4072 .global1_addr
= 0x1b,
4073 .age_time_coeff
= 15000,
4075 .tag_protocol
= DSA_TAG_PROTO_DSA
,
4076 .flags
= MV88E6XXX_FLAGS_FAMILY_6390
,
4077 .ops
= &mv88e6290_ops
,
4081 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6320
,
4082 .family
= MV88E6XXX_FAMILY_6320
,
4083 .name
= "Marvell 88E6320",
4084 .num_databases
= 4096,
4086 .port_base_addr
= 0x10,
4087 .global1_addr
= 0x1b,
4088 .age_time_coeff
= 15000,
4090 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
4091 .flags
= MV88E6XXX_FLAGS_FAMILY_6320
,
4092 .ops
= &mv88e6320_ops
,
4096 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6321
,
4097 .family
= MV88E6XXX_FAMILY_6320
,
4098 .name
= "Marvell 88E6321",
4099 .num_databases
= 4096,
4101 .port_base_addr
= 0x10,
4102 .global1_addr
= 0x1b,
4103 .age_time_coeff
= 15000,
4105 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
4106 .flags
= MV88E6XXX_FLAGS_FAMILY_6320
,
4107 .ops
= &mv88e6321_ops
,
4111 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6350
,
4112 .family
= MV88E6XXX_FAMILY_6351
,
4113 .name
= "Marvell 88E6350",
4114 .num_databases
= 4096,
4116 .port_base_addr
= 0x10,
4117 .global1_addr
= 0x1b,
4118 .age_time_coeff
= 15000,
4120 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
4121 .flags
= MV88E6XXX_FLAGS_FAMILY_6351
,
4122 .ops
= &mv88e6350_ops
,
4126 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6351
,
4127 .family
= MV88E6XXX_FAMILY_6351
,
4128 .name
= "Marvell 88E6351",
4129 .num_databases
= 4096,
4131 .port_base_addr
= 0x10,
4132 .global1_addr
= 0x1b,
4133 .age_time_coeff
= 15000,
4135 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
4136 .flags
= MV88E6XXX_FLAGS_FAMILY_6351
,
4137 .ops
= &mv88e6351_ops
,
4141 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6352
,
4142 .family
= MV88E6XXX_FAMILY_6352
,
4143 .name
= "Marvell 88E6352",
4144 .num_databases
= 4096,
4146 .port_base_addr
= 0x10,
4147 .global1_addr
= 0x1b,
4148 .age_time_coeff
= 15000,
4150 .tag_protocol
= DSA_TAG_PROTO_EDSA
,
4151 .flags
= MV88E6XXX_FLAGS_FAMILY_6352
,
4152 .ops
= &mv88e6352_ops
,
4155 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6390
,
4156 .family
= MV88E6XXX_FAMILY_6390
,
4157 .name
= "Marvell 88E6390",
4158 .num_databases
= 4096,
4159 .num_ports
= 11, /* 10 + Z80 */
4160 .port_base_addr
= 0x0,
4161 .global1_addr
= 0x1b,
4162 .age_time_coeff
= 15000,
4164 .tag_protocol
= DSA_TAG_PROTO_DSA
,
4165 .flags
= MV88E6XXX_FLAGS_FAMILY_6390
,
4166 .ops
= &mv88e6390_ops
,
4169 .prod_num
= PORT_SWITCH_ID_PROD_NUM_6390X
,
4170 .family
= MV88E6XXX_FAMILY_6390
,
4171 .name
= "Marvell 88E6390X",
4172 .num_databases
= 4096,
4173 .num_ports
= 11, /* 10 + Z80 */
4174 .port_base_addr
= 0x0,
4175 .global1_addr
= 0x1b,
4176 .age_time_coeff
= 15000,
4178 .tag_protocol
= DSA_TAG_PROTO_DSA
,
4179 .flags
= MV88E6XXX_FLAGS_FAMILY_6390
,
4180 .ops
= &mv88e6390x_ops
,
4184 static const struct mv88e6xxx_info
*mv88e6xxx_lookup_info(unsigned int prod_num
)
4188 for (i
= 0; i
< ARRAY_SIZE(mv88e6xxx_table
); ++i
)
4189 if (mv88e6xxx_table
[i
].prod_num
== prod_num
)
4190 return &mv88e6xxx_table
[i
];
4195 static int mv88e6xxx_detect(struct mv88e6xxx_chip
*chip
)
4197 const struct mv88e6xxx_info
*info
;
4198 unsigned int prod_num
, rev
;
4202 mutex_lock(&chip
->reg_lock
);
4203 err
= mv88e6xxx_port_read(chip
, 0, PORT_SWITCH_ID
, &id
);
4204 mutex_unlock(&chip
->reg_lock
);
4208 prod_num
= (id
& 0xfff0) >> 4;
4211 info
= mv88e6xxx_lookup_info(prod_num
);
4215 /* Update the compatible info with the probed one */
4218 err
= mv88e6xxx_g2_require(chip
);
4222 dev_info(chip
->dev
, "switch 0x%x detected: %s, revision %u\n",
4223 chip
->info
->prod_num
, chip
->info
->name
, rev
);
4228 static struct mv88e6xxx_chip
*mv88e6xxx_alloc_chip(struct device
*dev
)
4230 struct mv88e6xxx_chip
*chip
;
4232 chip
= devm_kzalloc(dev
, sizeof(*chip
), GFP_KERNEL
);
4238 mutex_init(&chip
->reg_lock
);
4243 static void mv88e6xxx_phy_init(struct mv88e6xxx_chip
*chip
)
4245 if (chip
->info
->ops
->ppu_enable
&& chip
->info
->ops
->ppu_disable
)
4246 mv88e6xxx_ppu_state_init(chip
);
4249 static void mv88e6xxx_phy_destroy(struct mv88e6xxx_chip
*chip
)
4251 if (chip
->info
->ops
->ppu_enable
&& chip
->info
->ops
->ppu_disable
)
4252 mv88e6xxx_ppu_state_destroy(chip
);
4255 static int mv88e6xxx_smi_init(struct mv88e6xxx_chip
*chip
,
4256 struct mii_bus
*bus
, int sw_addr
)
4259 chip
->smi_ops
= &mv88e6xxx_smi_single_chip_ops
;
4260 else if (mv88e6xxx_has(chip
, MV88E6XXX_FLAGS_MULTI_CHIP
))
4261 chip
->smi_ops
= &mv88e6xxx_smi_multi_chip_ops
;
4266 chip
->sw_addr
= sw_addr
;
4271 static enum dsa_tag_protocol
mv88e6xxx_get_tag_protocol(struct dsa_switch
*ds
)
4273 struct mv88e6xxx_chip
*chip
= ds
->priv
;
4275 return chip
->info
->tag_protocol
;
4278 static const char *mv88e6xxx_drv_probe(struct device
*dsa_dev
,
4279 struct device
*host_dev
, int sw_addr
,
4282 struct mv88e6xxx_chip
*chip
;
4283 struct mii_bus
*bus
;
4286 bus
= dsa_host_dev_to_mii_bus(host_dev
);
4290 chip
= mv88e6xxx_alloc_chip(dsa_dev
);
4294 /* Legacy SMI probing will only support chips similar to 88E6085 */
4295 chip
->info
= &mv88e6xxx_table
[MV88E6085
];
4297 err
= mv88e6xxx_smi_init(chip
, bus
, sw_addr
);
4301 err
= mv88e6xxx_detect(chip
);
4305 mutex_lock(&chip
->reg_lock
);
4306 err
= mv88e6xxx_switch_reset(chip
);
4307 mutex_unlock(&chip
->reg_lock
);
4311 mv88e6xxx_phy_init(chip
);
4313 err
= mv88e6xxx_mdio_register(chip
, NULL
);
4319 return chip
->info
->name
;
4321 devm_kfree(dsa_dev
, chip
);
4326 static int mv88e6xxx_port_mdb_prepare(struct dsa_switch
*ds
, int port
,
4327 const struct switchdev_obj_port_mdb
*mdb
,
4328 struct switchdev_trans
*trans
)
4330 /* We don't need any dynamic resource from the kernel (yet),
4331 * so skip the prepare phase.
4337 static void mv88e6xxx_port_mdb_add(struct dsa_switch
*ds
, int port
,
4338 const struct switchdev_obj_port_mdb
*mdb
,
4339 struct switchdev_trans
*trans
)
4341 struct mv88e6xxx_chip
*chip
= ds
->priv
;
4343 mutex_lock(&chip
->reg_lock
);
4344 if (mv88e6xxx_port_db_load_purge(chip
, port
, mdb
->addr
, mdb
->vid
,
4345 GLOBAL_ATU_DATA_STATE_MC_STATIC
))
4346 netdev_err(ds
->ports
[port
].netdev
, "failed to load multicast MAC address\n");
4347 mutex_unlock(&chip
->reg_lock
);
4350 static int mv88e6xxx_port_mdb_del(struct dsa_switch
*ds
, int port
,
4351 const struct switchdev_obj_port_mdb
*mdb
)
4353 struct mv88e6xxx_chip
*chip
= ds
->priv
;
4356 mutex_lock(&chip
->reg_lock
);
4357 err
= mv88e6xxx_port_db_load_purge(chip
, port
, mdb
->addr
, mdb
->vid
,
4358 GLOBAL_ATU_DATA_STATE_UNUSED
);
4359 mutex_unlock(&chip
->reg_lock
);
4364 static int mv88e6xxx_port_mdb_dump(struct dsa_switch
*ds
, int port
,
4365 struct switchdev_obj_port_mdb
*mdb
,
4366 int (*cb
)(struct switchdev_obj
*obj
))
4368 struct mv88e6xxx_chip
*chip
= ds
->priv
;
4371 mutex_lock(&chip
->reg_lock
);
4372 err
= mv88e6xxx_port_db_dump(chip
, port
, &mdb
->obj
, cb
);
4373 mutex_unlock(&chip
->reg_lock
);
4378 static const struct dsa_switch_ops mv88e6xxx_switch_ops
= {
4379 .probe
= mv88e6xxx_drv_probe
,
4380 .get_tag_protocol
= mv88e6xxx_get_tag_protocol
,
4381 .setup
= mv88e6xxx_setup
,
4382 .set_addr
= mv88e6xxx_set_addr
,
4383 .adjust_link
= mv88e6xxx_adjust_link
,
4384 .get_strings
= mv88e6xxx_get_strings
,
4385 .get_ethtool_stats
= mv88e6xxx_get_ethtool_stats
,
4386 .get_sset_count
= mv88e6xxx_get_sset_count
,
4387 .set_eee
= mv88e6xxx_set_eee
,
4388 .get_eee
= mv88e6xxx_get_eee
,
4389 #ifdef CONFIG_NET_DSA_HWMON
4390 .get_temp
= mv88e6xxx_get_temp
,
4391 .get_temp_limit
= mv88e6xxx_get_temp_limit
,
4392 .set_temp_limit
= mv88e6xxx_set_temp_limit
,
4393 .get_temp_alarm
= mv88e6xxx_get_temp_alarm
,
4395 .get_eeprom_len
= mv88e6xxx_get_eeprom_len
,
4396 .get_eeprom
= mv88e6xxx_get_eeprom
,
4397 .set_eeprom
= mv88e6xxx_set_eeprom
,
4398 .get_regs_len
= mv88e6xxx_get_regs_len
,
4399 .get_regs
= mv88e6xxx_get_regs
,
4400 .set_ageing_time
= mv88e6xxx_set_ageing_time
,
4401 .port_bridge_join
= mv88e6xxx_port_bridge_join
,
4402 .port_bridge_leave
= mv88e6xxx_port_bridge_leave
,
4403 .port_stp_state_set
= mv88e6xxx_port_stp_state_set
,
4404 .port_fast_age
= mv88e6xxx_port_fast_age
,
4405 .port_vlan_filtering
= mv88e6xxx_port_vlan_filtering
,
4406 .port_vlan_prepare
= mv88e6xxx_port_vlan_prepare
,
4407 .port_vlan_add
= mv88e6xxx_port_vlan_add
,
4408 .port_vlan_del
= mv88e6xxx_port_vlan_del
,
4409 .port_vlan_dump
= mv88e6xxx_port_vlan_dump
,
4410 .port_fdb_prepare
= mv88e6xxx_port_fdb_prepare
,
4411 .port_fdb_add
= mv88e6xxx_port_fdb_add
,
4412 .port_fdb_del
= mv88e6xxx_port_fdb_del
,
4413 .port_fdb_dump
= mv88e6xxx_port_fdb_dump
,
4414 .port_mdb_prepare
= mv88e6xxx_port_mdb_prepare
,
4415 .port_mdb_add
= mv88e6xxx_port_mdb_add
,
4416 .port_mdb_del
= mv88e6xxx_port_mdb_del
,
4417 .port_mdb_dump
= mv88e6xxx_port_mdb_dump
,
4420 static struct dsa_switch_driver mv88e6xxx_switch_drv
= {
4421 .ops
= &mv88e6xxx_switch_ops
,
4424 static int mv88e6xxx_register_switch(struct mv88e6xxx_chip
*chip
,
4425 struct device_node
*np
)
4427 struct device
*dev
= chip
->dev
;
4428 struct dsa_switch
*ds
;
4430 ds
= devm_kzalloc(dev
, sizeof(*ds
), GFP_KERNEL
);
4436 ds
->ops
= &mv88e6xxx_switch_ops
;
4438 dev_set_drvdata(dev
, ds
);
4440 return dsa_register_switch(ds
, np
);
4443 static void mv88e6xxx_unregister_switch(struct mv88e6xxx_chip
*chip
)
4445 dsa_unregister_switch(chip
->ds
);
4448 static int mv88e6xxx_probe(struct mdio_device
*mdiodev
)
4450 struct device
*dev
= &mdiodev
->dev
;
4451 struct device_node
*np
= dev
->of_node
;
4452 const struct mv88e6xxx_info
*compat_info
;
4453 struct mv88e6xxx_chip
*chip
;
4457 compat_info
= of_device_get_match_data(dev
);
4461 chip
= mv88e6xxx_alloc_chip(dev
);
4465 chip
->info
= compat_info
;
4467 err
= mv88e6xxx_verify_madatory_ops(chip
, chip
->info
->ops
);
4471 err
= mv88e6xxx_smi_init(chip
, mdiodev
->bus
, mdiodev
->addr
);
4475 chip
->reset
= devm_gpiod_get_optional(dev
, "reset", GPIOD_OUT_LOW
);
4476 if (IS_ERR(chip
->reset
))
4477 return PTR_ERR(chip
->reset
);
4479 err
= mv88e6xxx_detect(chip
);
4483 mv88e6xxx_phy_init(chip
);
4485 if (chip
->info
->ops
->get_eeprom
&&
4486 !of_property_read_u32(np
, "eeprom-length", &eeprom_len
))
4487 chip
->eeprom_len
= eeprom_len
;
4489 mutex_lock(&chip
->reg_lock
);
4490 err
= mv88e6xxx_switch_reset(chip
);
4491 mutex_unlock(&chip
->reg_lock
);
4495 chip
->irq
= of_irq_get(np
, 0);
4496 if (chip
->irq
== -EPROBE_DEFER
) {
4501 if (chip
->irq
> 0) {
4502 /* Has to be performed before the MDIO bus is created,
4503 * because the PHYs will link there interrupts to these
4504 * interrupt controllers
4506 mutex_lock(&chip
->reg_lock
);
4507 err
= mv88e6xxx_g1_irq_setup(chip
);
4508 mutex_unlock(&chip
->reg_lock
);
4513 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAG_G2_INT
)) {
4514 err
= mv88e6xxx_g2_irq_setup(chip
);
4520 err
= mv88e6xxx_mdio_register(chip
, np
);
4524 err
= mv88e6xxx_register_switch(chip
, np
);
4531 mv88e6xxx_mdio_unregister(chip
);
4533 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAG_G2_INT
) && chip
->irq
> 0)
4534 mv88e6xxx_g2_irq_free(chip
);
4536 if (chip
->irq
> 0) {
4537 mutex_lock(&chip
->reg_lock
);
4538 mv88e6xxx_g1_irq_free(chip
);
4539 mutex_unlock(&chip
->reg_lock
);
4545 static void mv88e6xxx_remove(struct mdio_device
*mdiodev
)
4547 struct dsa_switch
*ds
= dev_get_drvdata(&mdiodev
->dev
);
4548 struct mv88e6xxx_chip
*chip
= ds
->priv
;
4550 mv88e6xxx_phy_destroy(chip
);
4551 mv88e6xxx_unregister_switch(chip
);
4552 mv88e6xxx_mdio_unregister(chip
);
4554 if (chip
->irq
> 0) {
4555 if (mv88e6xxx_has(chip
, MV88E6XXX_FLAG_G2_INT
))
4556 mv88e6xxx_g2_irq_free(chip
);
4557 mv88e6xxx_g1_irq_free(chip
);
4561 static const struct of_device_id mv88e6xxx_of_match
[] = {
4563 .compatible
= "marvell,mv88e6085",
4564 .data
= &mv88e6xxx_table
[MV88E6085
],
4567 .compatible
= "marvell,mv88e6190",
4568 .data
= &mv88e6xxx_table
[MV88E6190
],
4573 MODULE_DEVICE_TABLE(of
, mv88e6xxx_of_match
);
4575 static struct mdio_driver mv88e6xxx_driver
= {
4576 .probe
= mv88e6xxx_probe
,
4577 .remove
= mv88e6xxx_remove
,
4579 .name
= "mv88e6085",
4580 .of_match_table
= mv88e6xxx_of_match
,
4584 static int __init
mv88e6xxx_init(void)
4586 register_switch_driver(&mv88e6xxx_switch_drv
);
4587 return mdio_driver_register(&mv88e6xxx_driver
);
4589 module_init(mv88e6xxx_init
);
4591 static void __exit
mv88e6xxx_cleanup(void)
4593 mdio_driver_unregister(&mv88e6xxx_driver
);
4594 unregister_switch_driver(&mv88e6xxx_switch_drv
);
4596 module_exit(mv88e6xxx_cleanup
);
4598 MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
4599 MODULE_DESCRIPTION("Driver for Marvell 88E6XXX ethernet switch chips");
4600 MODULE_LICENSE("GPL");