1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause
3 *
4 * Copyright (c) 2022 Adrian Chadd <adrian@FreeBSD.org>.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 * SUCH DAMAGE.
26 */
27
28 #include <sys/param.h>
29 #include <sys/bus.h>
30 #include <sys/errno.h>
31 #include <sys/kernel.h>
32 #include <sys/malloc.h>
33 #include <sys/module.h>
34 #include <sys/socket.h>
35 #include <sys/sockio.h>
36 #include <sys/sysctl.h>
37 #include <sys/systm.h>
38
39 #include <net/if.h>
40 #include <net/if_var.h>
41 #include <net/if_arp.h>
42 #include <net/ethernet.h>
43 #include <net/if_dl.h>
44 #include <net/if_media.h>
45 #include <net/if_types.h>
46
47 #include <machine/bus.h>
48 #include <dev/iicbus/iic.h>
49 #include <dev/iicbus/iiconf.h>
50 #include <dev/iicbus/iicbus.h>
51 #include <dev/mii/mii.h>
52 #include <dev/mii/miivar.h>
53 #include <dev/mdio/mdio.h>
54 #include <dev/clk/clk.h>
55 #include <dev/hwreset/hwreset.h>
56
57 #include <dev/fdt/fdt_common.h>
58 #include <dev/ofw/ofw_bus.h>
59 #include <dev/ofw/ofw_bus_subr.h>
60
61 #include <dev/etherswitch/etherswitch.h>
62
63 #include <dev/etherswitch/ar40xx/ar40xx_var.h>
64 #include <dev/etherswitch/ar40xx/ar40xx_reg.h>
65 #include <dev/etherswitch/ar40xx/ar40xx_hw.h>
66 #include <dev/etherswitch/ar40xx/ar40xx_hw_mirror.h>
67
68 #include "mdio_if.h"
69 #include "miibus_if.h"
70 #include "etherswitch_if.h"
71
72
73 int
ar40xx_hw_mirror_set_registers(struct ar40xx_softc * sc)74 ar40xx_hw_mirror_set_registers(struct ar40xx_softc *sc)
75 {
76 uint32_t reg;
77 int port;
78
79 /* Reset the mirror registers before configuring */
80 reg = AR40XX_REG_READ(sc, AR40XX_REG_FWD_CTRL0);
81 reg &= ~(AR40XX_FWD_CTRL0_MIRROR_PORT);
82 reg |= (0xF << AR40XX_FWD_CTRL0_MIRROR_PORT_S);
83 AR40XX_REG_WRITE(sc, AR40XX_REG_FWD_CTRL0, reg);
84 AR40XX_REG_BARRIER_WRITE(sc);
85
86 for (port = 0; port < AR40XX_NUM_PORTS; port++) {
87 reg = AR40XX_REG_READ(sc, AR40XX_REG_PORT_LOOKUP(port));
88 reg &= ~AR40XX_PORT_LOOKUP_ING_MIRROR_EN;
89 AR40XX_REG_WRITE(sc, AR40XX_REG_PORT_LOOKUP(port), reg);
90
91 reg = AR40XX_REG_READ(sc, AR40XX_REG_PORT_HOL_CTRL1(port));
92 reg &= ~AR40XX_PORT_HOL_CTRL1_EG_MIRROR_EN;
93 AR40XX_REG_WRITE(sc, AR40XX_REG_PORT_HOL_CTRL1(port), reg);
94
95 AR40XX_REG_BARRIER_WRITE(sc);
96 }
97
98 /* Now, enable mirroring if requested */
99 if (sc->sc_monitor.source_port >= AR40XX_NUM_PORTS
100 || sc->sc_monitor.monitor_port >= AR40XX_NUM_PORTS
101 || sc->sc_monitor.source_port == sc->sc_monitor.monitor_port) {
102 return (0);
103 }
104
105 reg = AR40XX_REG_READ(sc, AR40XX_REG_FWD_CTRL0);
106 reg &= ~AR40XX_FWD_CTRL0_MIRROR_PORT;
107 reg |=
108 (sc->sc_monitor.monitor_port << AR40XX_FWD_CTRL0_MIRROR_PORT_S);
109 AR40XX_REG_WRITE(sc, AR40XX_REG_FWD_CTRL0, reg);
110
111 if (sc->sc_monitor.mirror_rx) {
112 reg = AR40XX_REG_READ(sc,
113 AR40XX_REG_PORT_LOOKUP(sc->sc_monitor.source_port));
114 reg |= AR40XX_PORT_LOOKUP_ING_MIRROR_EN;
115 AR40XX_REG_WRITE(sc,
116 AR40XX_REG_PORT_LOOKUP(sc->sc_monitor.source_port),
117 reg);
118 AR40XX_REG_BARRIER_WRITE(sc);
119 }
120
121 if (sc->sc_monitor.mirror_tx) {
122 reg = AR40XX_REG_READ(sc,
123 AR40XX_REG_PORT_HOL_CTRL1(sc->sc_monitor.source_port));
124 reg |= AR40XX_PORT_HOL_CTRL1_EG_MIRROR_EN;
125 AR40XX_REG_WRITE(sc,
126 AR40XX_REG_PORT_HOL_CTRL1(sc->sc_monitor.source_port),
127 reg);
128 AR40XX_REG_BARRIER_WRITE(sc);
129 }
130
131 return (0);
132 }
133