2 * net/dsa/mv88e6xxx.c - Marvell 88e6xxx switch chip support
3 * Copyright (c) 2008 Marvell Semiconductor
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
11 #include <linux/debugfs.h>
12 #include <linux/delay.h>
13 #include <linux/etherdevice.h>
14 #include <linux/if_bridge.h>
15 #include <linux/jiffies.h>
16 #include <linux/list.h>
17 #include <linux/module.h>
18 #include <linux/netdevice.h>
19 #include <linux/phy.h>
20 #include <linux/seq_file.h>
22 #include "mv88e6xxx.h"
24 /* MDIO bus access can be nested in the case of PHYs connected to the
25 * internal MDIO bus of the switch, which is accessed via MDIO bus of
26 * the Ethernet interface. Avoid lockdep false positives by using
27 * mutex_lock_nested().
29 static int mv88e6xxx_mdiobus_read(struct mii_bus
*bus
, int addr
, u32 regnum
)
33 mutex_lock_nested(&bus
->mdio_lock
, SINGLE_DEPTH_NESTING
);
34 ret
= bus
->read(bus
, addr
, regnum
);
35 mutex_unlock(&bus
->mdio_lock
);
40 static int mv88e6xxx_mdiobus_write(struct mii_bus
*bus
, int addr
, u32 regnum
,
45 mutex_lock_nested(&bus
->mdio_lock
, SINGLE_DEPTH_NESTING
);
46 ret
= bus
->write(bus
, addr
, regnum
, val
);
47 mutex_unlock(&bus
->mdio_lock
);
52 /* If the switch's ADDR[4:0] strap pins are strapped to zero, it will
53 * use all 32 SMI bus addresses on its SMI bus, and all switch registers
54 * will be directly accessible on some {device address,register address}
55 * pair. If the ADDR[4:0] pins are not strapped to zero, the switch
56 * will only respond to SMI transactions to that specific address, and
57 * an indirect addressing mechanism needs to be used to access its
60 static int mv88e6xxx_reg_wait_ready(struct mii_bus
*bus
, int sw_addr
)
65 for (i
= 0; i
< 16; i
++) {
66 ret
= mv88e6xxx_mdiobus_read(bus
, sw_addr
, SMI_CMD
);
70 if ((ret
& SMI_CMD_BUSY
) == 0)
77 int __mv88e6xxx_reg_read(struct mii_bus
*bus
, int sw_addr
, int addr
, int reg
)
82 return mv88e6xxx_mdiobus_read(bus
, addr
, reg
);
84 /* Wait for the bus to become free. */
85 ret
= mv88e6xxx_reg_wait_ready(bus
, sw_addr
);
89 /* Transmit the read command. */
90 ret
= mv88e6xxx_mdiobus_write(bus
, sw_addr
, SMI_CMD
,
91 SMI_CMD_OP_22_READ
| (addr
<< 5) | reg
);
95 /* Wait for the read command to complete. */
96 ret
= mv88e6xxx_reg_wait_ready(bus
, sw_addr
);
101 ret
= mv88e6xxx_mdiobus_read(bus
, sw_addr
, SMI_DATA
);
108 /* Must be called with SMI mutex held */
109 static int _mv88e6xxx_reg_read(struct dsa_switch
*ds
, int addr
, int reg
)
111 struct mii_bus
*bus
= dsa_host_dev_to_mii_bus(ds
->master_dev
);
117 ret
= __mv88e6xxx_reg_read(bus
, ds
->pd
->sw_addr
, addr
, reg
);
121 dev_dbg(ds
->master_dev
, "<- addr: 0x%.2x reg: 0x%.2x val: 0x%.4x\n",
127 int mv88e6xxx_reg_read(struct dsa_switch
*ds
, int addr
, int reg
)
129 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
132 mutex_lock(&ps
->smi_mutex
);
133 ret
= _mv88e6xxx_reg_read(ds
, addr
, reg
);
134 mutex_unlock(&ps
->smi_mutex
);
139 int __mv88e6xxx_reg_write(struct mii_bus
*bus
, int sw_addr
, int addr
,
145 return mv88e6xxx_mdiobus_write(bus
, addr
, reg
, val
);
147 /* Wait for the bus to become free. */
148 ret
= mv88e6xxx_reg_wait_ready(bus
, sw_addr
);
152 /* Transmit the data to write. */
153 ret
= mv88e6xxx_mdiobus_write(bus
, sw_addr
, SMI_DATA
, val
);
157 /* Transmit the write command. */
158 ret
= mv88e6xxx_mdiobus_write(bus
, sw_addr
, SMI_CMD
,
159 SMI_CMD_OP_22_WRITE
| (addr
<< 5) | reg
);
163 /* Wait for the write command to complete. */
164 ret
= mv88e6xxx_reg_wait_ready(bus
, sw_addr
);
171 /* Must be called with SMI mutex held */
172 static int _mv88e6xxx_reg_write(struct dsa_switch
*ds
, int addr
, int reg
,
175 struct mii_bus
*bus
= dsa_host_dev_to_mii_bus(ds
->master_dev
);
180 dev_dbg(ds
->master_dev
, "-> addr: 0x%.2x reg: 0x%.2x val: 0x%.4x\n",
183 return __mv88e6xxx_reg_write(bus
, ds
->pd
->sw_addr
, addr
, reg
, val
);
186 int mv88e6xxx_reg_write(struct dsa_switch
*ds
, int addr
, int reg
, u16 val
)
188 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
191 mutex_lock(&ps
->smi_mutex
);
192 ret
= _mv88e6xxx_reg_write(ds
, addr
, reg
, val
);
193 mutex_unlock(&ps
->smi_mutex
);
198 int mv88e6xxx_set_addr_direct(struct dsa_switch
*ds
, u8
*addr
)
200 REG_WRITE(REG_GLOBAL
, GLOBAL_MAC_01
, (addr
[0] << 8) | addr
[1]);
201 REG_WRITE(REG_GLOBAL
, GLOBAL_MAC_23
, (addr
[2] << 8) | addr
[3]);
202 REG_WRITE(REG_GLOBAL
, GLOBAL_MAC_45
, (addr
[4] << 8) | addr
[5]);
207 int mv88e6xxx_set_addr_indirect(struct dsa_switch
*ds
, u8
*addr
)
212 for (i
= 0; i
< 6; i
++) {
215 /* Write the MAC address byte. */
216 REG_WRITE(REG_GLOBAL2
, GLOBAL2_SWITCH_MAC
,
217 GLOBAL2_SWITCH_MAC_BUSY
| (i
<< 8) | addr
[i
]);
219 /* Wait for the write to complete. */
220 for (j
= 0; j
< 16; j
++) {
221 ret
= REG_READ(REG_GLOBAL2
, GLOBAL2_SWITCH_MAC
);
222 if ((ret
& GLOBAL2_SWITCH_MAC_BUSY
) == 0)
232 /* Must be called with SMI mutex held */
233 static int _mv88e6xxx_phy_read(struct dsa_switch
*ds
, int addr
, int regnum
)
236 return _mv88e6xxx_reg_read(ds
, addr
, regnum
);
240 /* Must be called with SMI mutex held */
241 static int _mv88e6xxx_phy_write(struct dsa_switch
*ds
, int addr
, int regnum
,
245 return _mv88e6xxx_reg_write(ds
, addr
, regnum
, val
);
249 #ifdef CONFIG_NET_DSA_MV88E6XXX_NEED_PPU
250 static int mv88e6xxx_ppu_disable(struct dsa_switch
*ds
)
253 unsigned long timeout
;
255 ret
= REG_READ(REG_GLOBAL
, GLOBAL_CONTROL
);
256 REG_WRITE(REG_GLOBAL
, GLOBAL_CONTROL
,
257 ret
& ~GLOBAL_CONTROL_PPU_ENABLE
);
259 timeout
= jiffies
+ 1 * HZ
;
260 while (time_before(jiffies
, timeout
)) {
261 ret
= REG_READ(REG_GLOBAL
, GLOBAL_STATUS
);
262 usleep_range(1000, 2000);
263 if ((ret
& GLOBAL_STATUS_PPU_MASK
) !=
264 GLOBAL_STATUS_PPU_POLLING
)
271 static int mv88e6xxx_ppu_enable(struct dsa_switch
*ds
)
274 unsigned long timeout
;
276 ret
= REG_READ(REG_GLOBAL
, GLOBAL_CONTROL
);
277 REG_WRITE(REG_GLOBAL
, GLOBAL_CONTROL
, ret
| GLOBAL_CONTROL_PPU_ENABLE
);
279 timeout
= jiffies
+ 1 * HZ
;
280 while (time_before(jiffies
, timeout
)) {
281 ret
= REG_READ(REG_GLOBAL
, GLOBAL_STATUS
);
282 usleep_range(1000, 2000);
283 if ((ret
& GLOBAL_STATUS_PPU_MASK
) ==
284 GLOBAL_STATUS_PPU_POLLING
)
291 static void mv88e6xxx_ppu_reenable_work(struct work_struct
*ugly
)
293 struct mv88e6xxx_priv_state
*ps
;
295 ps
= container_of(ugly
, struct mv88e6xxx_priv_state
, ppu_work
);
296 if (mutex_trylock(&ps
->ppu_mutex
)) {
297 struct dsa_switch
*ds
= ((struct dsa_switch
*)ps
) - 1;
299 if (mv88e6xxx_ppu_enable(ds
) == 0)
300 ps
->ppu_disabled
= 0;
301 mutex_unlock(&ps
->ppu_mutex
);
305 static void mv88e6xxx_ppu_reenable_timer(unsigned long _ps
)
307 struct mv88e6xxx_priv_state
*ps
= (void *)_ps
;
309 schedule_work(&ps
->ppu_work
);
312 static int mv88e6xxx_ppu_access_get(struct dsa_switch
*ds
)
314 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
317 mutex_lock(&ps
->ppu_mutex
);
319 /* If the PHY polling unit is enabled, disable it so that
320 * we can access the PHY registers. If it was already
321 * disabled, cancel the timer that is going to re-enable
324 if (!ps
->ppu_disabled
) {
325 ret
= mv88e6xxx_ppu_disable(ds
);
327 mutex_unlock(&ps
->ppu_mutex
);
330 ps
->ppu_disabled
= 1;
332 del_timer(&ps
->ppu_timer
);
339 static void mv88e6xxx_ppu_access_put(struct dsa_switch
*ds
)
341 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
343 /* Schedule a timer to re-enable the PHY polling unit. */
344 mod_timer(&ps
->ppu_timer
, jiffies
+ msecs_to_jiffies(10));
345 mutex_unlock(&ps
->ppu_mutex
);
348 void mv88e6xxx_ppu_state_init(struct dsa_switch
*ds
)
350 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
352 mutex_init(&ps
->ppu_mutex
);
353 INIT_WORK(&ps
->ppu_work
, mv88e6xxx_ppu_reenable_work
);
354 init_timer(&ps
->ppu_timer
);
355 ps
->ppu_timer
.data
= (unsigned long)ps
;
356 ps
->ppu_timer
.function
= mv88e6xxx_ppu_reenable_timer
;
359 int mv88e6xxx_phy_read_ppu(struct dsa_switch
*ds
, int addr
, int regnum
)
363 ret
= mv88e6xxx_ppu_access_get(ds
);
365 ret
= mv88e6xxx_reg_read(ds
, addr
, regnum
);
366 mv88e6xxx_ppu_access_put(ds
);
372 int mv88e6xxx_phy_write_ppu(struct dsa_switch
*ds
, int addr
,
377 ret
= mv88e6xxx_ppu_access_get(ds
);
379 ret
= mv88e6xxx_reg_write(ds
, addr
, regnum
, val
);
380 mv88e6xxx_ppu_access_put(ds
);
387 void mv88e6xxx_poll_link(struct dsa_switch
*ds
)
391 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
392 struct net_device
*dev
;
393 int uninitialized_var(port_status
);
404 if (dev
->flags
& IFF_UP
) {
405 port_status
= mv88e6xxx_reg_read(ds
, REG_PORT(i
),
410 link
= !!(port_status
& PORT_STATUS_LINK
);
414 if (netif_carrier_ok(dev
)) {
415 netdev_info(dev
, "link down\n");
416 netif_carrier_off(dev
);
421 switch (port_status
& PORT_STATUS_SPEED_MASK
) {
422 case PORT_STATUS_SPEED_10
:
425 case PORT_STATUS_SPEED_100
:
428 case PORT_STATUS_SPEED_1000
:
435 duplex
= (port_status
& PORT_STATUS_DUPLEX
) ? 1 : 0;
436 fc
= (port_status
& PORT_STATUS_PAUSE_EN
) ? 1 : 0;
438 if (!netif_carrier_ok(dev
)) {
440 "link up, %d Mb/s, %s duplex, flow control %sabled\n",
442 duplex
? "full" : "half",
444 netif_carrier_on(dev
);
449 static bool mv88e6xxx_6065_family(struct dsa_switch
*ds
)
451 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
454 case PORT_SWITCH_ID_6031
:
455 case PORT_SWITCH_ID_6061
:
456 case PORT_SWITCH_ID_6035
:
457 case PORT_SWITCH_ID_6065
:
463 static bool mv88e6xxx_6095_family(struct dsa_switch
*ds
)
465 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
468 case PORT_SWITCH_ID_6092
:
469 case PORT_SWITCH_ID_6095
:
475 static bool mv88e6xxx_6097_family(struct dsa_switch
*ds
)
477 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
480 case PORT_SWITCH_ID_6046
:
481 case PORT_SWITCH_ID_6085
:
482 case PORT_SWITCH_ID_6096
:
483 case PORT_SWITCH_ID_6097
:
489 static bool mv88e6xxx_6165_family(struct dsa_switch
*ds
)
491 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
494 case PORT_SWITCH_ID_6123
:
495 case PORT_SWITCH_ID_6161
:
496 case PORT_SWITCH_ID_6165
:
502 static bool mv88e6xxx_6185_family(struct dsa_switch
*ds
)
504 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
507 case PORT_SWITCH_ID_6121
:
508 case PORT_SWITCH_ID_6122
:
509 case PORT_SWITCH_ID_6152
:
510 case PORT_SWITCH_ID_6155
:
511 case PORT_SWITCH_ID_6182
:
512 case PORT_SWITCH_ID_6185
:
513 case PORT_SWITCH_ID_6108
:
514 case PORT_SWITCH_ID_6131
:
520 static bool mv88e6xxx_6320_family(struct dsa_switch
*ds
)
522 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
525 case PORT_SWITCH_ID_6320
:
526 case PORT_SWITCH_ID_6321
:
532 static bool mv88e6xxx_6351_family(struct dsa_switch
*ds
)
534 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
537 case PORT_SWITCH_ID_6171
:
538 case PORT_SWITCH_ID_6175
:
539 case PORT_SWITCH_ID_6350
:
540 case PORT_SWITCH_ID_6351
:
546 static bool mv88e6xxx_6352_family(struct dsa_switch
*ds
)
548 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
551 case PORT_SWITCH_ID_6172
:
552 case PORT_SWITCH_ID_6176
:
553 case PORT_SWITCH_ID_6240
:
554 case PORT_SWITCH_ID_6352
:
560 /* Must be called with SMI mutex held */
561 static int _mv88e6xxx_stats_wait(struct dsa_switch
*ds
)
566 for (i
= 0; i
< 10; i
++) {
567 ret
= _mv88e6xxx_reg_read(ds
, REG_GLOBAL
, GLOBAL_STATS_OP
);
568 if ((ret
& GLOBAL_STATS_OP_BUSY
) == 0)
575 /* Must be called with SMI mutex held */
576 static int _mv88e6xxx_stats_snapshot(struct dsa_switch
*ds
, int port
)
580 if (mv88e6xxx_6320_family(ds
) || mv88e6xxx_6352_family(ds
))
581 port
= (port
+ 1) << 5;
583 /* Snapshot the hardware statistics counters for this port. */
584 ret
= _mv88e6xxx_reg_write(ds
, REG_GLOBAL
, GLOBAL_STATS_OP
,
585 GLOBAL_STATS_OP_CAPTURE_PORT
|
586 GLOBAL_STATS_OP_HIST_RX_TX
| port
);
590 /* Wait for the snapshotting to complete. */
591 ret
= _mv88e6xxx_stats_wait(ds
);
598 /* Must be called with SMI mutex held */
599 static void _mv88e6xxx_stats_read(struct dsa_switch
*ds
, int stat
, u32
*val
)
606 ret
= _mv88e6xxx_reg_write(ds
, REG_GLOBAL
, GLOBAL_STATS_OP
,
607 GLOBAL_STATS_OP_READ_CAPTURED
|
608 GLOBAL_STATS_OP_HIST_RX_TX
| stat
);
612 ret
= _mv88e6xxx_stats_wait(ds
);
616 ret
= _mv88e6xxx_reg_read(ds
, REG_GLOBAL
, GLOBAL_STATS_COUNTER_32
);
622 ret
= _mv88e6xxx_reg_read(ds
, REG_GLOBAL
, GLOBAL_STATS_COUNTER_01
);
629 static struct mv88e6xxx_hw_stat mv88e6xxx_hw_stats
[] = {
630 { "in_good_octets", 8, 0x00, },
631 { "in_bad_octets", 4, 0x02, },
632 { "in_unicast", 4, 0x04, },
633 { "in_broadcasts", 4, 0x06, },
634 { "in_multicasts", 4, 0x07, },
635 { "in_pause", 4, 0x16, },
636 { "in_undersize", 4, 0x18, },
637 { "in_fragments", 4, 0x19, },
638 { "in_oversize", 4, 0x1a, },
639 { "in_jabber", 4, 0x1b, },
640 { "in_rx_error", 4, 0x1c, },
641 { "in_fcs_error", 4, 0x1d, },
642 { "out_octets", 8, 0x0e, },
643 { "out_unicast", 4, 0x10, },
644 { "out_broadcasts", 4, 0x13, },
645 { "out_multicasts", 4, 0x12, },
646 { "out_pause", 4, 0x15, },
647 { "excessive", 4, 0x11, },
648 { "collisions", 4, 0x1e, },
649 { "deferred", 4, 0x05, },
650 { "single", 4, 0x14, },
651 { "multiple", 4, 0x17, },
652 { "out_fcs_error", 4, 0x03, },
653 { "late", 4, 0x1f, },
654 { "hist_64bytes", 4, 0x08, },
655 { "hist_65_127bytes", 4, 0x09, },
656 { "hist_128_255bytes", 4, 0x0a, },
657 { "hist_256_511bytes", 4, 0x0b, },
658 { "hist_512_1023bytes", 4, 0x0c, },
659 { "hist_1024_max_bytes", 4, 0x0d, },
660 /* Not all devices have the following counters */
661 { "sw_in_discards", 4, 0x110, },
662 { "sw_in_filtered", 2, 0x112, },
663 { "sw_out_filtered", 2, 0x113, },
667 static bool have_sw_in_discards(struct dsa_switch
*ds
)
669 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
672 case PORT_SWITCH_ID_6095
: case PORT_SWITCH_ID_6161
:
673 case PORT_SWITCH_ID_6165
: case PORT_SWITCH_ID_6171
:
674 case PORT_SWITCH_ID_6172
: case PORT_SWITCH_ID_6176
:
675 case PORT_SWITCH_ID_6182
: case PORT_SWITCH_ID_6185
:
676 case PORT_SWITCH_ID_6352
:
683 static void _mv88e6xxx_get_strings(struct dsa_switch
*ds
,
685 struct mv88e6xxx_hw_stat
*stats
,
686 int port
, uint8_t *data
)
690 for (i
= 0; i
< nr_stats
; i
++) {
691 memcpy(data
+ i
* ETH_GSTRING_LEN
,
692 stats
[i
].string
, ETH_GSTRING_LEN
);
696 static uint64_t _mv88e6xxx_get_ethtool_stat(struct dsa_switch
*ds
,
698 struct mv88e6xxx_hw_stat
*stats
,
701 struct mv88e6xxx_hw_stat
*s
= stats
+ stat
;
707 if (s
->reg
>= 0x100) {
708 ret
= _mv88e6xxx_reg_read(ds
, REG_PORT(port
),
714 if (s
->sizeof_stat
== 4) {
715 ret
= _mv88e6xxx_reg_read(ds
, REG_PORT(port
),
722 _mv88e6xxx_stats_read(ds
, s
->reg
, &low
);
723 if (s
->sizeof_stat
== 8)
724 _mv88e6xxx_stats_read(ds
, s
->reg
+ 1, &high
);
726 value
= (((u64
)high
) << 16) | low
;
730 static void _mv88e6xxx_get_ethtool_stats(struct dsa_switch
*ds
,
732 struct mv88e6xxx_hw_stat
*stats
,
733 int port
, uint64_t *data
)
735 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
739 mutex_lock(&ps
->smi_mutex
);
741 ret
= _mv88e6xxx_stats_snapshot(ds
, port
);
743 mutex_unlock(&ps
->smi_mutex
);
747 /* Read each of the counters. */
748 for (i
= 0; i
< nr_stats
; i
++)
749 data
[i
] = _mv88e6xxx_get_ethtool_stat(ds
, i
, stats
, port
);
751 mutex_unlock(&ps
->smi_mutex
);
754 /* All the statistics in the table */
756 mv88e6xxx_get_strings(struct dsa_switch
*ds
, int port
, uint8_t *data
)
758 if (have_sw_in_discards(ds
))
759 _mv88e6xxx_get_strings(ds
, ARRAY_SIZE(mv88e6xxx_hw_stats
),
760 mv88e6xxx_hw_stats
, port
, data
);
762 _mv88e6xxx_get_strings(ds
, ARRAY_SIZE(mv88e6xxx_hw_stats
) - 3,
763 mv88e6xxx_hw_stats
, port
, data
);
766 int mv88e6xxx_get_sset_count(struct dsa_switch
*ds
)
768 if (have_sw_in_discards(ds
))
769 return ARRAY_SIZE(mv88e6xxx_hw_stats
);
770 return ARRAY_SIZE(mv88e6xxx_hw_stats
) - 3;
774 mv88e6xxx_get_ethtool_stats(struct dsa_switch
*ds
,
775 int port
, uint64_t *data
)
777 if (have_sw_in_discards(ds
))
778 _mv88e6xxx_get_ethtool_stats(
779 ds
, ARRAY_SIZE(mv88e6xxx_hw_stats
),
780 mv88e6xxx_hw_stats
, port
, data
);
782 _mv88e6xxx_get_ethtool_stats(
783 ds
, ARRAY_SIZE(mv88e6xxx_hw_stats
) - 3,
784 mv88e6xxx_hw_stats
, port
, data
);
787 int mv88e6xxx_get_regs_len(struct dsa_switch
*ds
, int port
)
789 return 32 * sizeof(u16
);
792 void mv88e6xxx_get_regs(struct dsa_switch
*ds
, int port
,
793 struct ethtool_regs
*regs
, void *_p
)
800 memset(p
, 0xff, 32 * sizeof(u16
));
802 for (i
= 0; i
< 32; i
++) {
805 ret
= mv88e6xxx_reg_read(ds
, REG_PORT(port
), i
);
811 /* Must be called with SMI lock held */
812 static int _mv88e6xxx_wait(struct dsa_switch
*ds
, int reg
, int offset
,
815 unsigned long timeout
= jiffies
+ HZ
/ 10;
817 while (time_before(jiffies
, timeout
)) {
820 ret
= _mv88e6xxx_reg_read(ds
, reg
, offset
);
826 usleep_range(1000, 2000);
831 static int mv88e6xxx_wait(struct dsa_switch
*ds
, int reg
, int offset
, u16 mask
)
833 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
836 mutex_lock(&ps
->smi_mutex
);
837 ret
= _mv88e6xxx_wait(ds
, reg
, offset
, mask
);
838 mutex_unlock(&ps
->smi_mutex
);
843 static int _mv88e6xxx_phy_wait(struct dsa_switch
*ds
)
845 return _mv88e6xxx_wait(ds
, REG_GLOBAL2
, GLOBAL2_SMI_OP
,
846 GLOBAL2_SMI_OP_BUSY
);
849 int mv88e6xxx_eeprom_load_wait(struct dsa_switch
*ds
)
851 return mv88e6xxx_wait(ds
, REG_GLOBAL2
, GLOBAL2_EEPROM_OP
,
852 GLOBAL2_EEPROM_OP_LOAD
);
855 int mv88e6xxx_eeprom_busy_wait(struct dsa_switch
*ds
)
857 return mv88e6xxx_wait(ds
, REG_GLOBAL2
, GLOBAL2_EEPROM_OP
,
858 GLOBAL2_EEPROM_OP_BUSY
);
861 /* Must be called with SMI lock held */
862 static int _mv88e6xxx_atu_wait(struct dsa_switch
*ds
)
864 return _mv88e6xxx_wait(ds
, REG_GLOBAL
, GLOBAL_ATU_OP
,
868 /* Must be called with SMI lock held */
869 static int _mv88e6xxx_scratch_wait(struct dsa_switch
*ds
)
871 return _mv88e6xxx_wait(ds
, REG_GLOBAL2
, GLOBAL2_SCRATCH_MISC
,
872 GLOBAL2_SCRATCH_BUSY
);
875 /* Must be called with SMI mutex held */
876 static int _mv88e6xxx_phy_read_indirect(struct dsa_switch
*ds
, int addr
,
881 ret
= _mv88e6xxx_reg_write(ds
, REG_GLOBAL2
, GLOBAL2_SMI_OP
,
882 GLOBAL2_SMI_OP_22_READ
| (addr
<< 5) |
887 ret
= _mv88e6xxx_phy_wait(ds
);
891 return _mv88e6xxx_reg_read(ds
, REG_GLOBAL2
, GLOBAL2_SMI_DATA
);
894 /* Must be called with SMI mutex held */
895 static int _mv88e6xxx_phy_write_indirect(struct dsa_switch
*ds
, int addr
,
900 ret
= _mv88e6xxx_reg_write(ds
, REG_GLOBAL2
, GLOBAL2_SMI_DATA
, val
);
904 ret
= _mv88e6xxx_reg_write(ds
, REG_GLOBAL2
, GLOBAL2_SMI_OP
,
905 GLOBAL2_SMI_OP_22_WRITE
| (addr
<< 5) |
908 return _mv88e6xxx_phy_wait(ds
);
911 int mv88e6xxx_get_eee(struct dsa_switch
*ds
, int port
, struct ethtool_eee
*e
)
913 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
916 mutex_lock(&ps
->smi_mutex
);
918 reg
= _mv88e6xxx_phy_read_indirect(ds
, port
, 16);
922 e
->eee_enabled
= !!(reg
& 0x0200);
923 e
->tx_lpi_enabled
= !!(reg
& 0x0100);
925 reg
= _mv88e6xxx_reg_read(ds
, REG_PORT(port
), PORT_STATUS
);
929 e
->eee_active
= !!(reg
& PORT_STATUS_EEE
);
933 mutex_unlock(&ps
->smi_mutex
);
937 int mv88e6xxx_set_eee(struct dsa_switch
*ds
, int port
,
938 struct phy_device
*phydev
, struct ethtool_eee
*e
)
940 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
944 mutex_lock(&ps
->smi_mutex
);
946 ret
= _mv88e6xxx_phy_read_indirect(ds
, port
, 16);
953 if (e
->tx_lpi_enabled
)
956 ret
= _mv88e6xxx_phy_write_indirect(ds
, port
, 16, reg
);
958 mutex_unlock(&ps
->smi_mutex
);
963 static int _mv88e6xxx_atu_cmd(struct dsa_switch
*ds
, int fid
, u16 cmd
)
967 ret
= _mv88e6xxx_reg_write(ds
, REG_GLOBAL
, GLOBAL_ATU_FID
, fid
);
971 ret
= _mv88e6xxx_reg_write(ds
, REG_GLOBAL
, GLOBAL_ATU_OP
, cmd
);
975 return _mv88e6xxx_atu_wait(ds
);
978 static int _mv88e6xxx_flush_fid(struct dsa_switch
*ds
, int fid
)
982 ret
= _mv88e6xxx_atu_wait(ds
);
986 return _mv88e6xxx_atu_cmd(ds
, fid
, GLOBAL_ATU_OP_FLUSH_NON_STATIC_DB
);
989 static int mv88e6xxx_set_port_state(struct dsa_switch
*ds
, int port
, u8 state
)
991 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
995 mutex_lock(&ps
->smi_mutex
);
997 reg
= _mv88e6xxx_reg_read(ds
, REG_PORT(port
), PORT_CONTROL
);
1003 oldstate
= reg
& PORT_CONTROL_STATE_MASK
;
1004 if (oldstate
!= state
) {
1005 /* Flush forwarding database if we're moving a port
1006 * from Learning or Forwarding state to Disabled or
1007 * Blocking or Listening state.
1009 if (oldstate
>= PORT_CONTROL_STATE_LEARNING
&&
1010 state
<= PORT_CONTROL_STATE_BLOCKING
) {
1011 ret
= _mv88e6xxx_flush_fid(ds
, ps
->fid
[port
]);
1015 reg
= (reg
& ~PORT_CONTROL_STATE_MASK
) | state
;
1016 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
), PORT_CONTROL
,
1021 mutex_unlock(&ps
->smi_mutex
);
1025 /* Must be called with smi lock held */
1026 static int _mv88e6xxx_update_port_config(struct dsa_switch
*ds
, int port
)
1028 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1029 u8 fid
= ps
->fid
[port
];
1030 u16 reg
= fid
<< 12;
1032 if (dsa_is_cpu_port(ds
, port
))
1033 reg
|= ds
->phys_port_mask
;
1035 reg
|= (ps
->bridge_mask
[fid
] |
1036 (1 << dsa_upstream_port(ds
))) & ~(1 << port
);
1038 return _mv88e6xxx_reg_write(ds
, REG_PORT(port
), PORT_BASE_VLAN
, reg
);
1041 /* Must be called with smi lock held */
1042 static int _mv88e6xxx_update_bridge_config(struct dsa_switch
*ds
, int fid
)
1044 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1049 mask
= ds
->phys_port_mask
;
1052 mask
&= ~(1 << port
);
1053 if (ps
->fid
[port
] != fid
)
1056 ret
= _mv88e6xxx_update_port_config(ds
, port
);
1061 return _mv88e6xxx_flush_fid(ds
, fid
);
1064 /* Bridge handling functions */
1066 int mv88e6xxx_join_bridge(struct dsa_switch
*ds
, int port
, u32 br_port_mask
)
1068 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1073 /* If the bridge group is not empty, join that group.
1074 * Otherwise create a new group.
1076 fid
= ps
->fid
[port
];
1077 nmask
= br_port_mask
& ~(1 << port
);
1079 fid
= ps
->fid
[__ffs(nmask
)];
1081 nmask
= ps
->bridge_mask
[fid
] | (1 << port
);
1082 if (nmask
!= br_port_mask
) {
1083 netdev_err(ds
->ports
[port
],
1084 "join: Bridge port mask mismatch fid=%d mask=0x%x expected 0x%x\n",
1085 fid
, br_port_mask
, nmask
);
1089 mutex_lock(&ps
->smi_mutex
);
1091 ps
->bridge_mask
[fid
] = br_port_mask
;
1093 if (fid
!= ps
->fid
[port
]) {
1094 clear_bit(ps
->fid
[port
], ps
->fid_bitmap
);
1095 ps
->fid
[port
] = fid
;
1096 ret
= _mv88e6xxx_update_bridge_config(ds
, fid
);
1099 mutex_unlock(&ps
->smi_mutex
);
1104 int mv88e6xxx_leave_bridge(struct dsa_switch
*ds
, int port
, u32 br_port_mask
)
1106 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1110 fid
= ps
->fid
[port
];
1112 if (ps
->bridge_mask
[fid
] != br_port_mask
) {
1113 netdev_err(ds
->ports
[port
],
1114 "leave: Bridge port mask mismatch fid=%d mask=0x%x expected 0x%x\n",
1115 fid
, br_port_mask
, ps
->bridge_mask
[fid
]);
1119 /* If the port was the last port of a bridge, we are done.
1120 * Otherwise assign a new fid to the port, and fix up
1121 * the bridge configuration.
1123 if (br_port_mask
== (1 << port
))
1126 mutex_lock(&ps
->smi_mutex
);
1128 newfid
= find_next_zero_bit(ps
->fid_bitmap
, VLAN_N_VID
, 1);
1129 if (unlikely(newfid
> ps
->num_ports
)) {
1130 netdev_err(ds
->ports
[port
], "all first %d FIDs are used\n",
1136 ps
->fid
[port
] = newfid
;
1137 set_bit(newfid
, ps
->fid_bitmap
);
1138 ps
->bridge_mask
[fid
] &= ~(1 << port
);
1139 ps
->bridge_mask
[newfid
] = 1 << port
;
1141 ret
= _mv88e6xxx_update_bridge_config(ds
, fid
);
1143 ret
= _mv88e6xxx_update_bridge_config(ds
, newfid
);
1146 mutex_unlock(&ps
->smi_mutex
);
1151 int mv88e6xxx_port_stp_update(struct dsa_switch
*ds
, int port
, u8 state
)
1153 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1157 case BR_STATE_DISABLED
:
1158 stp_state
= PORT_CONTROL_STATE_DISABLED
;
1160 case BR_STATE_BLOCKING
:
1161 case BR_STATE_LISTENING
:
1162 stp_state
= PORT_CONTROL_STATE_BLOCKING
;
1164 case BR_STATE_LEARNING
:
1165 stp_state
= PORT_CONTROL_STATE_LEARNING
;
1167 case BR_STATE_FORWARDING
:
1169 stp_state
= PORT_CONTROL_STATE_FORWARDING
;
1173 netdev_dbg(ds
->ports
[port
], "port state %d [%d]\n", state
, stp_state
);
1175 /* mv88e6xxx_port_stp_update may be called with softirqs disabled,
1176 * so we can not update the port state directly but need to schedule it.
1178 ps
->port_state
[port
] = stp_state
;
1179 set_bit(port
, &ps
->port_state_update_mask
);
1180 schedule_work(&ps
->bridge_work
);
1185 static int _mv88e6xxx_atu_mac_write(struct dsa_switch
*ds
,
1186 const u8 addr
[ETH_ALEN
])
1190 for (i
= 0; i
< 3; i
++) {
1191 ret
= _mv88e6xxx_reg_write(
1192 ds
, REG_GLOBAL
, GLOBAL_ATU_MAC_01
+ i
,
1193 (addr
[i
* 2] << 8) | addr
[i
* 2 + 1]);
1201 static int _mv88e6xxx_atu_mac_read(struct dsa_switch
*ds
, u8 addr
[ETH_ALEN
])
1205 for (i
= 0; i
< 3; i
++) {
1206 ret
= _mv88e6xxx_reg_read(ds
, REG_GLOBAL
,
1207 GLOBAL_ATU_MAC_01
+ i
);
1210 addr
[i
* 2] = ret
>> 8;
1211 addr
[i
* 2 + 1] = ret
& 0xff;
1217 static int __mv88e6xxx_port_fdb_cmd(struct dsa_switch
*ds
, int port
,
1218 const unsigned char *addr
, int state
)
1220 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1221 u8 fid
= ps
->fid
[port
];
1224 ret
= _mv88e6xxx_atu_wait(ds
);
1228 ret
= _mv88e6xxx_atu_mac_write(ds
, addr
);
1232 ret
= _mv88e6xxx_reg_write(ds
, REG_GLOBAL
, GLOBAL_ATU_DATA
,
1233 (0x10 << port
) | state
);
1237 ret
= _mv88e6xxx_atu_cmd(ds
, fid
, GLOBAL_ATU_OP_LOAD_DB
);
1242 int mv88e6xxx_port_fdb_add(struct dsa_switch
*ds
, int port
,
1243 const unsigned char *addr
, u16 vid
)
1245 int state
= is_multicast_ether_addr(addr
) ?
1246 GLOBAL_ATU_DATA_STATE_MC_STATIC
:
1247 GLOBAL_ATU_DATA_STATE_UC_STATIC
;
1248 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1251 mutex_lock(&ps
->smi_mutex
);
1252 ret
= __mv88e6xxx_port_fdb_cmd(ds
, port
, addr
, state
);
1253 mutex_unlock(&ps
->smi_mutex
);
1258 int mv88e6xxx_port_fdb_del(struct dsa_switch
*ds
, int port
,
1259 const unsigned char *addr
, u16 vid
)
1261 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1264 mutex_lock(&ps
->smi_mutex
);
1265 ret
= __mv88e6xxx_port_fdb_cmd(ds
, port
, addr
,
1266 GLOBAL_ATU_DATA_STATE_UNUSED
);
1267 mutex_unlock(&ps
->smi_mutex
);
1272 static int _mv88e6xxx_atu_getnext(struct dsa_switch
*ds
, u16 fid
,
1273 const u8 addr
[ETH_ALEN
],
1274 struct mv88e6xxx_atu_entry
*entry
)
1276 struct mv88e6xxx_atu_entry next
= { 0 };
1281 ret
= _mv88e6xxx_atu_wait(ds
);
1285 ret
= _mv88e6xxx_atu_mac_write(ds
, addr
);
1289 ret
= _mv88e6xxx_atu_cmd(ds
, fid
, GLOBAL_ATU_OP_GET_NEXT_DB
);
1293 ret
= _mv88e6xxx_atu_mac_read(ds
, next
.mac
);
1297 ret
= _mv88e6xxx_reg_read(ds
, REG_GLOBAL
, GLOBAL_ATU_DATA
);
1301 next
.state
= ret
& GLOBAL_ATU_DATA_STATE_MASK
;
1302 if (next
.state
!= GLOBAL_ATU_DATA_STATE_UNUSED
) {
1303 unsigned int mask
, shift
;
1305 if (ret
& GLOBAL_ATU_DATA_TRUNK
) {
1307 mask
= GLOBAL_ATU_DATA_TRUNK_ID_MASK
;
1308 shift
= GLOBAL_ATU_DATA_TRUNK_ID_SHIFT
;
1311 mask
= GLOBAL_ATU_DATA_PORT_VECTOR_MASK
;
1312 shift
= GLOBAL_ATU_DATA_PORT_VECTOR_SHIFT
;
1315 next
.portv_trunkid
= (ret
& mask
) >> shift
;
1322 static int _mv88e6xxx_port_vid_to_fid(struct dsa_switch
*ds
, int port
, u16 vid
)
1324 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1327 return ps
->fid
[port
];
1332 int mv88e6xxx_port_fdb_getnext(struct dsa_switch
*ds
, int port
, u16
*vid
,
1333 u8 addr
[ETH_ALEN
], bool *is_static
)
1335 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1336 struct mv88e6xxx_atu_entry next
;
1340 mutex_lock(&ps
->smi_mutex
);
1342 ret
= _mv88e6xxx_port_vid_to_fid(ds
, port
, *vid
);
1348 if (is_broadcast_ether_addr(addr
)) {
1353 ret
= _mv88e6xxx_atu_getnext(ds
, fid
, addr
, &next
);
1357 ether_addr_copy(addr
, next
.mac
);
1359 if (next
.state
== GLOBAL_ATU_DATA_STATE_UNUSED
)
1361 } while (next
.trunk
|| (next
.portv_trunkid
& BIT(port
)) == 0);
1363 *is_static
= next
.state
== (is_multicast_ether_addr(addr
) ?
1364 GLOBAL_ATU_DATA_STATE_MC_STATIC
:
1365 GLOBAL_ATU_DATA_STATE_UC_STATIC
);
1367 mutex_unlock(&ps
->smi_mutex
);
1372 static void mv88e6xxx_bridge_work(struct work_struct
*work
)
1374 struct mv88e6xxx_priv_state
*ps
;
1375 struct dsa_switch
*ds
;
1378 ps
= container_of(work
, struct mv88e6xxx_priv_state
, bridge_work
);
1379 ds
= ((struct dsa_switch
*)ps
) - 1;
1381 while (ps
->port_state_update_mask
) {
1382 port
= __ffs(ps
->port_state_update_mask
);
1383 clear_bit(port
, &ps
->port_state_update_mask
);
1384 mv88e6xxx_set_port_state(ds
, port
, ps
->port_state
[port
]);
1388 static int mv88e6xxx_setup_port(struct dsa_switch
*ds
, int port
)
1390 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1394 mutex_lock(&ps
->smi_mutex
);
1396 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
1397 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
1398 mv88e6xxx_6185_family(ds
) || mv88e6xxx_6095_family(ds
) ||
1399 mv88e6xxx_6065_family(ds
) || mv88e6xxx_6320_family(ds
)) {
1400 /* MAC Forcing register: don't force link, speed,
1401 * duplex or flow control state to any particular
1402 * values on physical ports, but force the CPU port
1403 * and all DSA ports to their maximum bandwidth and
1406 reg
= _mv88e6xxx_reg_read(ds
, REG_PORT(port
), PORT_PCS_CTRL
);
1407 if (dsa_is_cpu_port(ds
, port
) ||
1408 ds
->dsa_port_mask
& (1 << port
)) {
1409 reg
|= PORT_PCS_CTRL_FORCE_LINK
|
1410 PORT_PCS_CTRL_LINK_UP
|
1411 PORT_PCS_CTRL_DUPLEX_FULL
|
1412 PORT_PCS_CTRL_FORCE_DUPLEX
;
1413 if (mv88e6xxx_6065_family(ds
))
1414 reg
|= PORT_PCS_CTRL_100
;
1416 reg
|= PORT_PCS_CTRL_1000
;
1418 reg
|= PORT_PCS_CTRL_UNFORCED
;
1421 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1422 PORT_PCS_CTRL
, reg
);
1427 /* Port Control: disable Drop-on-Unlock, disable Drop-on-Lock,
1428 * disable Header mode, enable IGMP/MLD snooping, disable VLAN
1429 * tunneling, determine priority by looking at 802.1p and IP
1430 * priority fields (IP prio has precedence), and set STP state
1433 * If this is the CPU link, use DSA or EDSA tagging depending
1434 * on which tagging mode was configured.
1436 * If this is a link to another switch, use DSA tagging mode.
1438 * If this is the upstream port for this switch, enable
1439 * forwarding of unknown unicasts and multicasts.
1442 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
1443 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
1444 mv88e6xxx_6095_family(ds
) || mv88e6xxx_6065_family(ds
) ||
1445 mv88e6xxx_6185_family(ds
) || mv88e6xxx_6320_family(ds
))
1446 reg
= PORT_CONTROL_IGMP_MLD_SNOOP
|
1447 PORT_CONTROL_USE_TAG
| PORT_CONTROL_USE_IP
|
1448 PORT_CONTROL_STATE_FORWARDING
;
1449 if (dsa_is_cpu_port(ds
, port
)) {
1450 if (mv88e6xxx_6095_family(ds
) || mv88e6xxx_6185_family(ds
))
1451 reg
|= PORT_CONTROL_DSA_TAG
;
1452 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
1453 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
1454 mv88e6xxx_6320_family(ds
)) {
1455 if (ds
->dst
->tag_protocol
== DSA_TAG_PROTO_EDSA
)
1456 reg
|= PORT_CONTROL_FRAME_ETHER_TYPE_DSA
;
1458 reg
|= PORT_CONTROL_FRAME_MODE_DSA
;
1461 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
1462 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
1463 mv88e6xxx_6095_family(ds
) || mv88e6xxx_6065_family(ds
) ||
1464 mv88e6xxx_6185_family(ds
) || mv88e6xxx_6320_family(ds
)) {
1465 if (ds
->dst
->tag_protocol
== DSA_TAG_PROTO_EDSA
)
1466 reg
|= PORT_CONTROL_EGRESS_ADD_TAG
;
1469 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
1470 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
1471 mv88e6xxx_6095_family(ds
) || mv88e6xxx_6065_family(ds
) ||
1472 mv88e6xxx_6320_family(ds
)) {
1473 if (ds
->dsa_port_mask
& (1 << port
))
1474 reg
|= PORT_CONTROL_FRAME_MODE_DSA
;
1475 if (port
== dsa_upstream_port(ds
))
1476 reg
|= PORT_CONTROL_FORWARD_UNKNOWN
|
1477 PORT_CONTROL_FORWARD_UNKNOWN_MC
;
1480 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1486 /* Port Control 2: don't force a good FCS, set the maximum
1487 * frame size to 10240 bytes, don't let the switch add or
1488 * strip 802.1q tags, don't discard tagged or untagged frames
1489 * on this port, do a destination address lookup on all
1490 * received packets as usual, disable ARP mirroring and don't
1491 * send a copy of all transmitted/received frames on this port
1495 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
1496 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
1497 mv88e6xxx_6095_family(ds
) || mv88e6xxx_6320_family(ds
))
1498 reg
= PORT_CONTROL_2_MAP_DA
;
1500 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
1501 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6320_family(ds
))
1502 reg
|= PORT_CONTROL_2_JUMBO_10240
;
1504 if (mv88e6xxx_6095_family(ds
) || mv88e6xxx_6185_family(ds
)) {
1505 /* Set the upstream port this port should use */
1506 reg
|= dsa_upstream_port(ds
);
1507 /* enable forwarding of unknown multicast addresses to
1510 if (port
== dsa_upstream_port(ds
))
1511 reg
|= PORT_CONTROL_2_FORWARD_UNKNOWN
;
1515 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1516 PORT_CONTROL_2
, reg
);
1521 /* Port Association Vector: when learning source addresses
1522 * of packets, add the address to the address database using
1523 * a port bitmap that has only the bit for this port set and
1524 * the other bits clear.
1526 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
), PORT_ASSOC_VECTOR
,
1531 /* Egress rate control 2: disable egress rate control. */
1532 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
), PORT_RATE_CONTROL_2
,
1537 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
1538 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
1539 mv88e6xxx_6320_family(ds
)) {
1540 /* Do not limit the period of time that this port can
1541 * be paused for by the remote end or the period of
1542 * time that this port can pause the remote end.
1544 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1545 PORT_PAUSE_CTRL
, 0x0000);
1549 /* Port ATU control: disable limiting the number of
1550 * address database entries that this port is allowed
1553 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1554 PORT_ATU_CONTROL
, 0x0000);
1555 /* Priority Override: disable DA, SA and VTU priority
1558 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1559 PORT_PRI_OVERRIDE
, 0x0000);
1563 /* Port Ethertype: use the Ethertype DSA Ethertype
1566 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1567 PORT_ETH_TYPE
, ETH_P_EDSA
);
1570 /* Tag Remap: use an identity 802.1p prio -> switch
1573 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1574 PORT_TAG_REGMAP_0123
, 0x3210);
1578 /* Tag Remap 2: use an identity 802.1p prio -> switch
1581 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1582 PORT_TAG_REGMAP_4567
, 0x7654);
1587 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
1588 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
1589 mv88e6xxx_6185_family(ds
) || mv88e6xxx_6095_family(ds
) ||
1590 mv88e6xxx_6320_family(ds
)) {
1591 /* Rate Control: disable ingress rate limiting. */
1592 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
),
1593 PORT_RATE_CONTROL
, 0x0001);
1598 /* Port Control 1: disable trunking, disable sending
1599 * learning messages to this port.
1601 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
), PORT_CONTROL_1
, 0x0000);
1605 /* Port based VLAN map: give each port its own address
1606 * database, allow the CPU port to talk to each of the 'real'
1607 * ports, and allow each of the 'real' ports to only talk to
1608 * the upstream port.
1611 ps
->fid
[port
] = fid
;
1612 set_bit(fid
, ps
->fid_bitmap
);
1614 if (!dsa_is_cpu_port(ds
, port
))
1615 ps
->bridge_mask
[fid
] = 1 << port
;
1617 ret
= _mv88e6xxx_update_port_config(ds
, port
);
1621 /* Default VLAN ID and priority: don't set a default VLAN
1622 * ID, and set the default packet priority to zero.
1624 ret
= _mv88e6xxx_reg_write(ds
, REG_PORT(port
), PORT_DEFAULT_VLAN
,
1627 mutex_unlock(&ps
->smi_mutex
);
1631 int mv88e6xxx_setup_ports(struct dsa_switch
*ds
)
1633 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1637 for (i
= 0; i
< ps
->num_ports
; i
++) {
1638 ret
= mv88e6xxx_setup_port(ds
, i
);
1645 static int mv88e6xxx_regs_show(struct seq_file
*s
, void *p
)
1647 struct dsa_switch
*ds
= s
->private;
1649 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1652 seq_puts(s
, " GLOBAL GLOBAL2 ");
1653 for (port
= 0 ; port
< ps
->num_ports
; port
++)
1654 seq_printf(s
, " %2d ", port
);
1657 for (reg
= 0; reg
< 32; reg
++) {
1658 seq_printf(s
, "%2x: ", reg
);
1659 seq_printf(s
, " %4x %4x ",
1660 mv88e6xxx_reg_read(ds
, REG_GLOBAL
, reg
),
1661 mv88e6xxx_reg_read(ds
, REG_GLOBAL2
, reg
));
1663 for (port
= 0 ; port
< ps
->num_ports
; port
++)
1664 seq_printf(s
, "%4x ",
1665 mv88e6xxx_reg_read(ds
, REG_PORT(port
), reg
));
1672 static int mv88e6xxx_regs_open(struct inode
*inode
, struct file
*file
)
1674 return single_open(file
, mv88e6xxx_regs_show
, inode
->i_private
);
1677 static const struct file_operations mv88e6xxx_regs_fops
= {
1678 .open
= mv88e6xxx_regs_open
,
1680 .llseek
= no_llseek
,
1681 .release
= single_release
,
1682 .owner
= THIS_MODULE
,
1685 static void mv88e6xxx_atu_show_header(struct seq_file
*s
)
1687 seq_puts(s
, "DB T/P Vec State Addr\n");
1690 static void mv88e6xxx_atu_show_entry(struct seq_file
*s
, int dbnum
,
1691 unsigned char *addr
, int data
)
1693 bool trunk
= !!(data
& GLOBAL_ATU_DATA_TRUNK
);
1694 int portvec
= ((data
& GLOBAL_ATU_DATA_PORT_VECTOR_MASK
) >>
1695 GLOBAL_ATU_DATA_PORT_VECTOR_SHIFT
);
1696 int state
= data
& GLOBAL_ATU_DATA_STATE_MASK
;
1698 seq_printf(s
, "%03x %5s %10pb %x %pM\n",
1699 dbnum
, (trunk
? "Trunk" : "Port"), &portvec
, state
, addr
);
1702 static int mv88e6xxx_atu_show_db(struct seq_file
*s
, struct dsa_switch
*ds
,
1705 unsigned char bcast
[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
1706 unsigned char addr
[6];
1707 int ret
, data
, state
;
1709 ret
= _mv88e6xxx_atu_mac_write(ds
, bcast
);
1714 ret
= _mv88e6xxx_atu_cmd(ds
, dbnum
, GLOBAL_ATU_OP_GET_NEXT_DB
);
1717 data
= _mv88e6xxx_reg_read(ds
, REG_GLOBAL
, GLOBAL_ATU_DATA
);
1721 state
= data
& GLOBAL_ATU_DATA_STATE_MASK
;
1722 if (state
== GLOBAL_ATU_DATA_STATE_UNUSED
)
1724 ret
= _mv88e6xxx_atu_mac_read(ds
, addr
);
1727 mv88e6xxx_atu_show_entry(s
, dbnum
, addr
, data
);
1728 } while (state
!= GLOBAL_ATU_DATA_STATE_UNUSED
);
1733 static int mv88e6xxx_atu_show(struct seq_file
*s
, void *p
)
1735 struct dsa_switch
*ds
= s
->private;
1736 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1739 mv88e6xxx_atu_show_header(s
);
1741 for (dbnum
= 0; dbnum
< 255; dbnum
++) {
1742 mutex_lock(&ps
->smi_mutex
);
1743 mv88e6xxx_atu_show_db(s
, ds
, dbnum
);
1744 mutex_unlock(&ps
->smi_mutex
);
1750 static int mv88e6xxx_atu_open(struct inode
*inode
, struct file
*file
)
1752 return single_open(file
, mv88e6xxx_atu_show
, inode
->i_private
);
1755 static const struct file_operations mv88e6xxx_atu_fops
= {
1756 .open
= mv88e6xxx_atu_open
,
1758 .llseek
= no_llseek
,
1759 .release
= single_release
,
1760 .owner
= THIS_MODULE
,
1763 static void mv88e6xxx_stats_show_header(struct seq_file
*s
,
1764 struct mv88e6xxx_priv_state
*ps
)
1768 seq_puts(s
, " Statistic ");
1769 for (port
= 0 ; port
< ps
->num_ports
; port
++)
1770 seq_printf(s
, "Port %2d ", port
);
1774 static int mv88e6xxx_stats_show(struct seq_file
*s
, void *p
)
1776 struct dsa_switch
*ds
= s
->private;
1777 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1778 struct mv88e6xxx_hw_stat
*stats
= mv88e6xxx_hw_stats
;
1779 int port
, stat
, max_stats
;
1782 if (have_sw_in_discards(ds
))
1783 max_stats
= ARRAY_SIZE(mv88e6xxx_hw_stats
);
1785 max_stats
= ARRAY_SIZE(mv88e6xxx_hw_stats
) - 3;
1787 mv88e6xxx_stats_show_header(s
, ps
);
1789 mutex_lock(&ps
->smi_mutex
);
1791 for (stat
= 0; stat
< max_stats
; stat
++) {
1792 seq_printf(s
, "%19s: ", stats
[stat
].string
);
1793 for (port
= 0 ; port
< ps
->num_ports
; port
++) {
1794 _mv88e6xxx_stats_snapshot(ds
, port
);
1795 value
= _mv88e6xxx_get_ethtool_stat(ds
, stat
, stats
,
1797 seq_printf(s
, "%8llu ", value
);
1801 mutex_unlock(&ps
->smi_mutex
);
1806 static int mv88e6xxx_stats_open(struct inode
*inode
, struct file
*file
)
1808 return single_open(file
, mv88e6xxx_stats_show
, inode
->i_private
);
1811 static const struct file_operations mv88e6xxx_stats_fops
= {
1812 .open
= mv88e6xxx_stats_open
,
1814 .llseek
= no_llseek
,
1815 .release
= single_release
,
1816 .owner
= THIS_MODULE
,
1819 static int mv88e6xxx_device_map_show(struct seq_file
*s
, void *p
)
1821 struct dsa_switch
*ds
= s
->private;
1822 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1825 seq_puts(s
, "Target Port\n");
1827 mutex_lock(&ps
->smi_mutex
);
1828 for (target
= 0; target
< 32; target
++) {
1829 ret
= _mv88e6xxx_reg_write(
1830 ds
, REG_GLOBAL2
, GLOBAL2_DEVICE_MAPPING
,
1831 target
<< GLOBAL2_DEVICE_MAPPING_TARGET_SHIFT
);
1834 ret
= _mv88e6xxx_reg_read(ds
, REG_GLOBAL2
,
1835 GLOBAL2_DEVICE_MAPPING
);
1836 seq_printf(s
, " %2d %2d\n", target
,
1837 ret
& GLOBAL2_DEVICE_MAPPING_PORT_MASK
);
1840 mutex_unlock(&ps
->smi_mutex
);
1845 static int mv88e6xxx_device_map_open(struct inode
*inode
, struct file
*file
)
1847 return single_open(file
, mv88e6xxx_device_map_show
, inode
->i_private
);
1850 static const struct file_operations mv88e6xxx_device_map_fops
= {
1851 .open
= mv88e6xxx_device_map_open
,
1853 .llseek
= no_llseek
,
1854 .release
= single_release
,
1855 .owner
= THIS_MODULE
,
1858 static int mv88e6xxx_scratch_show(struct seq_file
*s
, void *p
)
1860 struct dsa_switch
*ds
= s
->private;
1861 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1864 seq_puts(s
, "Register Value\n");
1866 mutex_lock(&ps
->smi_mutex
);
1867 for (reg
= 0; reg
< 0x80; reg
++) {
1868 ret
= _mv88e6xxx_reg_write(
1869 ds
, REG_GLOBAL2
, GLOBAL2_SCRATCH_MISC
,
1870 reg
<< GLOBAL2_SCRATCH_REGISTER_SHIFT
);
1874 ret
= _mv88e6xxx_scratch_wait(ds
);
1878 ret
= _mv88e6xxx_reg_read(ds
, REG_GLOBAL2
,
1879 GLOBAL2_SCRATCH_MISC
);
1880 seq_printf(s
, " %2x %2x\n", reg
,
1881 ret
& GLOBAL2_SCRATCH_VALUE_MASK
);
1884 mutex_unlock(&ps
->smi_mutex
);
1889 static int mv88e6xxx_scratch_open(struct inode
*inode
, struct file
*file
)
1891 return single_open(file
, mv88e6xxx_scratch_show
, inode
->i_private
);
1894 static const struct file_operations mv88e6xxx_scratch_fops
= {
1895 .open
= mv88e6xxx_scratch_open
,
1897 .llseek
= no_llseek
,
1898 .release
= single_release
,
1899 .owner
= THIS_MODULE
,
1902 int mv88e6xxx_setup_common(struct dsa_switch
*ds
)
1904 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1907 mutex_init(&ps
->smi_mutex
);
1909 ps
->id
= REG_READ(REG_PORT(0), PORT_SWITCH_ID
) & 0xfff0;
1911 INIT_WORK(&ps
->bridge_work
, mv88e6xxx_bridge_work
);
1913 name
= kasprintf(GFP_KERNEL
, "dsa%d", ds
->index
);
1914 ps
->dbgfs
= debugfs_create_dir(name
, NULL
);
1917 debugfs_create_file("regs", S_IRUGO
, ps
->dbgfs
, ds
,
1918 &mv88e6xxx_regs_fops
);
1920 debugfs_create_file("atu", S_IRUGO
, ps
->dbgfs
, ds
,
1921 &mv88e6xxx_atu_fops
);
1923 debugfs_create_file("stats", S_IRUGO
, ps
->dbgfs
, ds
,
1924 &mv88e6xxx_stats_fops
);
1926 debugfs_create_file("device_map", S_IRUGO
, ps
->dbgfs
, ds
,
1927 &mv88e6xxx_device_map_fops
);
1929 debugfs_create_file("scratch", S_IRUGO
, ps
->dbgfs
, ds
,
1930 &mv88e6xxx_scratch_fops
);
1934 int mv88e6xxx_setup_global(struct dsa_switch
*ds
)
1936 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
1940 /* Set the default address aging time to 5 minutes, and
1941 * enable address learn messages to be sent to all message
1944 REG_WRITE(REG_GLOBAL
, GLOBAL_ATU_CONTROL
,
1945 0x0140 | GLOBAL_ATU_CONTROL_LEARN2ALL
);
1947 /* Configure the IP ToS mapping registers. */
1948 REG_WRITE(REG_GLOBAL
, GLOBAL_IP_PRI_0
, 0x0000);
1949 REG_WRITE(REG_GLOBAL
, GLOBAL_IP_PRI_1
, 0x0000);
1950 REG_WRITE(REG_GLOBAL
, GLOBAL_IP_PRI_2
, 0x5555);
1951 REG_WRITE(REG_GLOBAL
, GLOBAL_IP_PRI_3
, 0x5555);
1952 REG_WRITE(REG_GLOBAL
, GLOBAL_IP_PRI_4
, 0xaaaa);
1953 REG_WRITE(REG_GLOBAL
, GLOBAL_IP_PRI_5
, 0xaaaa);
1954 REG_WRITE(REG_GLOBAL
, GLOBAL_IP_PRI_6
, 0xffff);
1955 REG_WRITE(REG_GLOBAL
, GLOBAL_IP_PRI_7
, 0xffff);
1957 /* Configure the IEEE 802.1p priority mapping register. */
1958 REG_WRITE(REG_GLOBAL
, GLOBAL_IEEE_PRI
, 0xfa41);
1960 /* Send all frames with destination addresses matching
1961 * 01:80:c2:00:00:0x to the CPU port.
1963 REG_WRITE(REG_GLOBAL2
, GLOBAL2_MGMT_EN_0X
, 0xffff);
1965 /* Ignore removed tag data on doubly tagged packets, disable
1966 * flow control messages, force flow control priority to the
1967 * highest, and send all special multicast frames to the CPU
1968 * port at the highest priority.
1970 REG_WRITE(REG_GLOBAL2
, GLOBAL2_SWITCH_MGMT
,
1971 0x7 | GLOBAL2_SWITCH_MGMT_RSVD2CPU
| 0x70 |
1972 GLOBAL2_SWITCH_MGMT_FORCE_FLOW_CTRL_PRI
);
1974 /* Program the DSA routing table. */
1975 for (i
= 0; i
< 32; i
++) {
1978 if (ds
->pd
->rtable
&&
1979 i
!= ds
->index
&& i
< ds
->dst
->pd
->nr_chips
)
1980 nexthop
= ds
->pd
->rtable
[i
] & 0x1f;
1982 REG_WRITE(REG_GLOBAL2
, GLOBAL2_DEVICE_MAPPING
,
1983 GLOBAL2_DEVICE_MAPPING_UPDATE
|
1984 (i
<< GLOBAL2_DEVICE_MAPPING_TARGET_SHIFT
) |
1988 /* Clear all trunk masks. */
1989 for (i
= 0; i
< 8; i
++)
1990 REG_WRITE(REG_GLOBAL2
, GLOBAL2_TRUNK_MASK
,
1991 0x8000 | (i
<< GLOBAL2_TRUNK_MASK_NUM_SHIFT
) |
1992 ((1 << ps
->num_ports
) - 1));
1994 /* Clear all trunk mappings. */
1995 for (i
= 0; i
< 16; i
++)
1996 REG_WRITE(REG_GLOBAL2
, GLOBAL2_TRUNK_MAPPING
,
1997 GLOBAL2_TRUNK_MAPPING_UPDATE
|
1998 (i
<< GLOBAL2_TRUNK_MAPPING_ID_SHIFT
));
2000 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
2001 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
2002 mv88e6xxx_6320_family(ds
)) {
2003 /* Send all frames with destination addresses matching
2004 * 01:80:c2:00:00:2x to the CPU port.
2006 REG_WRITE(REG_GLOBAL2
, GLOBAL2_MGMT_EN_2X
, 0xffff);
2008 /* Initialise cross-chip port VLAN table to reset
2011 REG_WRITE(REG_GLOBAL2
, GLOBAL2_PVT_ADDR
, 0x9000);
2013 /* Clear the priority override table. */
2014 for (i
= 0; i
< 16; i
++)
2015 REG_WRITE(REG_GLOBAL2
, GLOBAL2_PRIO_OVERRIDE
,
2019 if (mv88e6xxx_6352_family(ds
) || mv88e6xxx_6351_family(ds
) ||
2020 mv88e6xxx_6165_family(ds
) || mv88e6xxx_6097_family(ds
) ||
2021 mv88e6xxx_6185_family(ds
) || mv88e6xxx_6095_family(ds
) ||
2022 mv88e6xxx_6320_family(ds
)) {
2023 /* Disable ingress rate limiting by resetting all
2024 * ingress rate limit registers to their initial
2027 for (i
= 0; i
< ps
->num_ports
; i
++)
2028 REG_WRITE(REG_GLOBAL2
, GLOBAL2_INGRESS_OP
,
2032 /* Clear the statistics counters for all ports */
2033 REG_WRITE(REG_GLOBAL
, GLOBAL_STATS_OP
, GLOBAL_STATS_OP_FLUSH_ALL
);
2035 /* Wait for the flush to complete. */
2036 mutex_lock(&ps
->smi_mutex
);
2037 ret
= _mv88e6xxx_stats_wait(ds
);
2038 mutex_unlock(&ps
->smi_mutex
);
2043 int mv88e6xxx_switch_reset(struct dsa_switch
*ds
, bool ppu_active
)
2045 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
2046 u16 is_reset
= (ppu_active
? 0x8800 : 0xc800);
2047 unsigned long timeout
;
2051 /* Set all ports to the disabled state. */
2052 for (i
= 0; i
< ps
->num_ports
; i
++) {
2053 ret
= REG_READ(REG_PORT(i
), PORT_CONTROL
);
2054 REG_WRITE(REG_PORT(i
), PORT_CONTROL
, ret
& 0xfffc);
2057 /* Wait for transmit queues to drain. */
2058 usleep_range(2000, 4000);
2060 /* Reset the switch. Keep the PPU active if requested. The PPU
2061 * needs to be active to support indirect phy register access
2062 * through global registers 0x18 and 0x19.
2065 REG_WRITE(REG_GLOBAL
, 0x04, 0xc000);
2067 REG_WRITE(REG_GLOBAL
, 0x04, 0xc400);
2069 /* Wait up to one second for reset to complete. */
2070 timeout
= jiffies
+ 1 * HZ
;
2071 while (time_before(jiffies
, timeout
)) {
2072 ret
= REG_READ(REG_GLOBAL
, 0x00);
2073 if ((ret
& is_reset
) == is_reset
)
2075 usleep_range(1000, 2000);
2077 if (time_after(jiffies
, timeout
))
2083 int mv88e6xxx_phy_page_read(struct dsa_switch
*ds
, int port
, int page
, int reg
)
2085 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
2088 mutex_lock(&ps
->smi_mutex
);
2089 ret
= _mv88e6xxx_phy_write_indirect(ds
, port
, 0x16, page
);
2092 ret
= _mv88e6xxx_phy_read_indirect(ds
, port
, reg
);
2094 _mv88e6xxx_phy_write_indirect(ds
, port
, 0x16, 0x0);
2095 mutex_unlock(&ps
->smi_mutex
);
2099 int mv88e6xxx_phy_page_write(struct dsa_switch
*ds
, int port
, int page
,
2102 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
2105 mutex_lock(&ps
->smi_mutex
);
2106 ret
= _mv88e6xxx_phy_write_indirect(ds
, port
, 0x16, page
);
2110 ret
= _mv88e6xxx_phy_write_indirect(ds
, port
, reg
, val
);
2112 _mv88e6xxx_phy_write_indirect(ds
, port
, 0x16, 0x0);
2113 mutex_unlock(&ps
->smi_mutex
);
2117 static int mv88e6xxx_port_to_phy_addr(struct dsa_switch
*ds
, int port
)
2119 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
2121 if (port
>= 0 && port
< ps
->num_ports
)
2127 mv88e6xxx_phy_read(struct dsa_switch
*ds
, int port
, int regnum
)
2129 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
2130 int addr
= mv88e6xxx_port_to_phy_addr(ds
, port
);
2136 mutex_lock(&ps
->smi_mutex
);
2137 ret
= _mv88e6xxx_phy_read(ds
, addr
, regnum
);
2138 mutex_unlock(&ps
->smi_mutex
);
2143 mv88e6xxx_phy_write(struct dsa_switch
*ds
, int port
, int regnum
, u16 val
)
2145 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
2146 int addr
= mv88e6xxx_port_to_phy_addr(ds
, port
);
2152 mutex_lock(&ps
->smi_mutex
);
2153 ret
= _mv88e6xxx_phy_write(ds
, addr
, regnum
, val
);
2154 mutex_unlock(&ps
->smi_mutex
);
2159 mv88e6xxx_phy_read_indirect(struct dsa_switch
*ds
, int port
, int regnum
)
2161 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
2162 int addr
= mv88e6xxx_port_to_phy_addr(ds
, port
);
2168 mutex_lock(&ps
->smi_mutex
);
2169 ret
= _mv88e6xxx_phy_read_indirect(ds
, addr
, regnum
);
2170 mutex_unlock(&ps
->smi_mutex
);
2175 mv88e6xxx_phy_write_indirect(struct dsa_switch
*ds
, int port
, int regnum
,
2178 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
2179 int addr
= mv88e6xxx_port_to_phy_addr(ds
, port
);
2185 mutex_lock(&ps
->smi_mutex
);
2186 ret
= _mv88e6xxx_phy_write_indirect(ds
, addr
, regnum
, val
);
2187 mutex_unlock(&ps
->smi_mutex
);
2191 #ifdef CONFIG_NET_DSA_HWMON
2193 static int mv88e61xx_get_temp(struct dsa_switch
*ds
, int *temp
)
2195 struct mv88e6xxx_priv_state
*ps
= ds_to_priv(ds
);
2201 mutex_lock(&ps
->smi_mutex
);
2203 ret
= _mv88e6xxx_phy_write(ds
, 0x0, 0x16, 0x6);
2207 /* Enable temperature sensor */
2208 ret
= _mv88e6xxx_phy_read(ds
, 0x0, 0x1a);
2212 ret
= _mv88e6xxx_phy_write(ds
, 0x0, 0x1a, ret
| (1 << 5));
2216 /* Wait for temperature to stabilize */
2217 usleep_range(10000, 12000);
2219 val
= _mv88e6xxx_phy_read(ds
, 0x0, 0x1a);
2225 /* Disable temperature sensor */
2226 ret
= _mv88e6xxx_phy_write(ds
, 0x0, 0x1a, ret
& ~(1 << 5));
2230 *temp
= ((val
& 0x1f) - 5) * 5;
2233 _mv88e6xxx_phy_write(ds
, 0x0, 0x16, 0x0);
2234 mutex_unlock(&ps
->smi_mutex
);
2238 static int mv88e63xx_get_temp(struct dsa_switch
*ds
, int *temp
)
2240 int phy
= mv88e6xxx_6320_family(ds
) ? 3 : 0;
2245 ret
= mv88e6xxx_phy_page_read(ds
, phy
, 6, 27);
2249 *temp
= (ret
& 0xff) - 25;
2254 int mv88e6xxx_get_temp(struct dsa_switch
*ds
, int *temp
)
2256 if (mv88e6xxx_6320_family(ds
) || mv88e6xxx_6352_family(ds
))
2257 return mv88e63xx_get_temp(ds
, temp
);
2259 return mv88e61xx_get_temp(ds
, temp
);
2262 int mv88e6xxx_get_temp_limit(struct dsa_switch
*ds
, int *temp
)
2264 int phy
= mv88e6xxx_6320_family(ds
) ? 3 : 0;
2267 if (!mv88e6xxx_6320_family(ds
) && !mv88e6xxx_6352_family(ds
))
2272 ret
= mv88e6xxx_phy_page_read(ds
, phy
, 6, 26);
2276 *temp
= (((ret
>> 8) & 0x1f) * 5) - 25;
2281 int mv88e6xxx_set_temp_limit(struct dsa_switch
*ds
, int temp
)
2283 int phy
= mv88e6xxx_6320_family(ds
) ? 3 : 0;
2286 if (!mv88e6xxx_6320_family(ds
) && !mv88e6xxx_6352_family(ds
))
2289 ret
= mv88e6xxx_phy_page_read(ds
, phy
, 6, 26);
2292 temp
= clamp_val(DIV_ROUND_CLOSEST(temp
, 5) + 5, 0, 0x1f);
2293 return mv88e6xxx_phy_page_write(ds
, phy
, 6, 26,
2294 (ret
& 0xe0ff) | (temp
<< 8));
2297 int mv88e6xxx_get_temp_alarm(struct dsa_switch
*ds
, bool *alarm
)
2299 int phy
= mv88e6xxx_6320_family(ds
) ? 3 : 0;
2302 if (!mv88e6xxx_6320_family(ds
) && !mv88e6xxx_6352_family(ds
))
2307 ret
= mv88e6xxx_phy_page_read(ds
, phy
, 6, 26);
2311 *alarm
= !!(ret
& 0x40);
2315 #endif /* CONFIG_NET_DSA_HWMON */
2317 static int __init
mv88e6xxx_init(void)
2319 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6131)
2320 register_switch_driver(&mv88e6131_switch_driver
);
2322 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6123_61_65)
2323 register_switch_driver(&mv88e6123_61_65_switch_driver
);
2325 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6352)
2326 register_switch_driver(&mv88e6352_switch_driver
);
2328 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6171)
2329 register_switch_driver(&mv88e6171_switch_driver
);
2333 module_init(mv88e6xxx_init
);
2335 static void __exit
mv88e6xxx_cleanup(void)
2337 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6171)
2338 unregister_switch_driver(&mv88e6171_switch_driver
);
2340 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6352)
2341 unregister_switch_driver(&mv88e6352_switch_driver
);
2343 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6123_61_65)
2344 unregister_switch_driver(&mv88e6123_61_65_switch_driver
);
2346 #if IS_ENABLED(CONFIG_NET_DSA_MV88E6131)
2347 unregister_switch_driver(&mv88e6131_switch_driver
);
2350 module_exit(mv88e6xxx_cleanup
);
2352 MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
2353 MODULE_DESCRIPTION("Driver for Marvell 88E6XXX ethernet switch chips");
2354 MODULE_LICENSE("GPL");