mirror of
git://git.openwrt.org/openwrt/openwrt.git
synced 2025-12-07 05:04:00 -05:00
Add a new microchipsw target aimed add supporting Microchip switch SoC-s. Start by supporting LAN969x SoC-s as the first subtarget. Signed-off-by: Robert Marko <robert.marko@sartura.hr>
307 lines
10 KiB
Diff
307 lines
10 KiB
Diff
From ad3d33e6ac44359d2414f11bcaf1ebb8ba64346d Mon Sep 17 00:00:00 2001
|
|
From: Daniel Machon <daniel.machon@microchip.com>
|
|
Date: Thu, 24 Oct 2024 00:01:31 +0200
|
|
Subject: [PATCH 55/82] net: sparx5: use is_sparx5() macro throughout
|
|
|
|
Use the is_sparx5() macro (introduced in earlier series [1]), in places
|
|
where we need to handle things a bit differently on lan969x.
|
|
|
|
These places are:
|
|
|
|
- in sparx5_dsm_calendar_update() we need to switch the calendar
|
|
from a to b on lan969x.
|
|
|
|
- in sparx5_start() we need to make sure the HSCH_SYS_CLK_PER
|
|
register is only touched on Sparx5.
|
|
|
|
- in sparx5_start() we need to disable VCAP and FDMA for lan969x
|
|
(will come in later series).
|
|
|
|
- in sparx5_mirror_port_get() we must make sure the
|
|
ANA_AC_PROBE_PORT_CFG1 register is only read on Sparx5.
|
|
|
|
- sparx5_netdev.c and sparx5_packet.c we need to use different IFH
|
|
(Internal Frame Header) offsets for lan969x.
|
|
|
|
- in sparx5_port_fifo_sz() we must bail out on lan969x.
|
|
|
|
- in sparx5_port_config_low_set() we must configure the phase
|
|
detection registers.
|
|
|
|
- in sparx5_port_config() and sparx5_port_init() we must do some
|
|
additional configuration of the port devices.
|
|
|
|
- in sparx5_dwrr_conf_set() we must derive the scheduling layer
|
|
|
|
[1] https://lore.kernel.org/netdev/20241004-b4-sparx5-lan969x-switch-driver-v2-8-d3290f581663@microchip.com/
|
|
|
|
Reviewed-by: Steen Hegelund <Steen.Hegelund@microchip.com>
|
|
Signed-off-by: Daniel Machon <daniel.machon@microchip.com>
|
|
Link: https://patch.msgid.link/20241024-sparx5-lan969x-switch-driver-2-v2-12-a0b5fae88a0f@microchip.com
|
|
Signed-off-by: Jakub Kicinski <kuba@kernel.org>
|
|
---
|
|
.../microchip/sparx5/sparx5_calendar.c | 21 ++++++++-
|
|
.../ethernet/microchip/sparx5/sparx5_main.c | 21 +++++----
|
|
.../ethernet/microchip/sparx5/sparx5_mirror.c | 10 +++-
|
|
.../ethernet/microchip/sparx5/sparx5_netdev.c | 17 ++++---
|
|
.../ethernet/microchip/sparx5/sparx5_packet.c | 3 +-
|
|
.../ethernet/microchip/sparx5/sparx5_port.c | 46 +++++++++++++++++++
|
|
.../ethernet/microchip/sparx5/sparx5_qos.c | 3 +-
|
|
7 files changed, 99 insertions(+), 22 deletions(-)
|
|
|
|
--- a/drivers/net/ethernet/microchip/sparx5/sparx5_calendar.c
|
|
+++ b/drivers/net/ethernet/microchip/sparx5/sparx5_calendar.c
|
|
@@ -531,8 +531,18 @@ check_err:
|
|
static int sparx5_dsm_calendar_update(struct sparx5 *sparx5, u32 taxi,
|
|
struct sparx5_calendar_data *data)
|
|
{
|
|
- u32 idx;
|
|
- u32 cal_len = sparx5_dsm_cal_len(data->schedule), len;
|
|
+ u32 cal_len = sparx5_dsm_cal_len(data->schedule), len, idx;
|
|
+
|
|
+ if (!is_sparx5(sparx5)) {
|
|
+ u32 val, act;
|
|
+
|
|
+ val = spx5_rd(sparx5, DSM_TAXI_CAL_CFG(taxi));
|
|
+ act = DSM_TAXI_CAL_CFG_CAL_SEL_STAT_GET(val);
|
|
+
|
|
+ spx5_rmw(DSM_TAXI_CAL_CFG_CAL_PGM_SEL_SET(!act),
|
|
+ DSM_TAXI_CAL_CFG_CAL_PGM_SEL,
|
|
+ sparx5, DSM_TAXI_CAL_CFG(taxi));
|
|
+ }
|
|
|
|
spx5_rmw(DSM_TAXI_CAL_CFG_CAL_PGM_ENA_SET(1),
|
|
DSM_TAXI_CAL_CFG_CAL_PGM_ENA,
|
|
@@ -556,6 +566,13 @@ static int sparx5_dsm_calendar_update(st
|
|
DSM_TAXI_CAL_CFG(taxi)));
|
|
if (len != cal_len - 1)
|
|
goto update_err;
|
|
+
|
|
+ if (!is_sparx5(sparx5)) {
|
|
+ spx5_rmw(DSM_TAXI_CAL_CFG_CAL_SWITCH_SET(1),
|
|
+ DSM_TAXI_CAL_CFG_CAL_SWITCH,
|
|
+ sparx5, DSM_TAXI_CAL_CFG(taxi));
|
|
+ }
|
|
+
|
|
return 0;
|
|
update_err:
|
|
dev_err(sparx5->dev, "Incorrect calendar length: %u\n", len);
|
|
--- a/drivers/net/ethernet/microchip/sparx5/sparx5_main.c
|
|
+++ b/drivers/net/ethernet/microchip/sparx5/sparx5_main.c
|
|
@@ -538,10 +538,11 @@ static int sparx5_init_coreclock(struct
|
|
sparx5->coreclock = freq;
|
|
clk_period = sparx5_clk_period(freq);
|
|
|
|
- spx5_rmw(HSCH_SYS_CLK_PER_100PS_SET(clk_period / 100),
|
|
- HSCH_SYS_CLK_PER_100PS,
|
|
- sparx5,
|
|
- HSCH_SYS_CLK_PER);
|
|
+ if (is_sparx5(sparx5))
|
|
+ spx5_rmw(HSCH_SYS_CLK_PER_100PS_SET(clk_period / 100),
|
|
+ HSCH_SYS_CLK_PER_100PS,
|
|
+ sparx5,
|
|
+ HSCH_SYS_CLK_PER);
|
|
|
|
spx5_rmw(ANA_AC_POL_BDLB_DLB_CTRL_CLK_PERIOD_01NS_SET(clk_period / 100),
|
|
ANA_AC_POL_BDLB_DLB_CTRL_CLK_PERIOD_01NS,
|
|
@@ -731,15 +732,17 @@ static int sparx5_start(struct sparx5 *s
|
|
if (err)
|
|
return err;
|
|
|
|
- err = sparx5_vcap_init(sparx5);
|
|
- if (err) {
|
|
- sparx5_unregister_notifier_blocks(sparx5);
|
|
- return err;
|
|
+ if (is_sparx5(sparx5)) {
|
|
+ err = sparx5_vcap_init(sparx5);
|
|
+ if (err) {
|
|
+ sparx5_unregister_notifier_blocks(sparx5);
|
|
+ return err;
|
|
+ }
|
|
}
|
|
|
|
/* Start Frame DMA with fallback to register based INJ/XTR */
|
|
err = -ENXIO;
|
|
- if (sparx5->fdma_irq >= 0) {
|
|
+ if (sparx5->fdma_irq >= 0 && is_sparx5(sparx5)) {
|
|
if (GCB_CHIP_ID_REV_ID_GET(sparx5->chip_id) > 0)
|
|
err = devm_request_irq(sparx5->dev,
|
|
sparx5->fdma_irq,
|
|
--- a/drivers/net/ethernet/microchip/sparx5/sparx5_mirror.c
|
|
+++ b/drivers/net/ethernet/microchip/sparx5/sparx5_mirror.c
|
|
@@ -24,8 +24,14 @@ static u32 sparx5_mirror_to_dir(bool ing
|
|
/* Get ports belonging to this mirror */
|
|
static u64 sparx5_mirror_port_get(struct sparx5 *sparx5, u32 idx)
|
|
{
|
|
- return (u64)spx5_rd(sparx5, ANA_AC_PROBE_PORT_CFG1(idx)) << 32 |
|
|
- spx5_rd(sparx5, ANA_AC_PROBE_PORT_CFG(idx));
|
|
+ u64 val;
|
|
+
|
|
+ val = spx5_rd(sparx5, ANA_AC_PROBE_PORT_CFG(idx));
|
|
+
|
|
+ if (is_sparx5(sparx5))
|
|
+ val |= (u64)spx5_rd(sparx5, ANA_AC_PROBE_PORT_CFG1(idx)) << 32;
|
|
+
|
|
+ return val;
|
|
}
|
|
|
|
/* Add port to mirror (only front ports) */
|
|
--- a/drivers/net/ethernet/microchip/sparx5/sparx5_netdev.c
|
|
+++ b/drivers/net/ethernet/microchip/sparx5/sparx5_netdev.c
|
|
@@ -64,16 +64,16 @@ void sparx5_set_port_ifh(struct sparx5 *
|
|
/* MISC.CPU_MASK/DPORT = Destination port */
|
|
ifh_encode_bitfield(ifh_hdr, portno, 29, 8);
|
|
/* MISC.PIPELINE_PT */
|
|
- ifh_encode_bitfield(ifh_hdr, 16, 37, 5);
|
|
+ ifh_encode_bitfield(ifh_hdr, is_sparx5(sparx5) ? 16 : 17, 37, 5);
|
|
/* MISC.PIPELINE_ACT */
|
|
ifh_encode_bitfield(ifh_hdr, 1, 42, 3);
|
|
/* FWD.SRC_PORT = CPU */
|
|
ifh_encode_bitfield(ifh_hdr, sparx5_get_pgid(sparx5, SPX5_PORT_CPU_0),
|
|
- 46, 7);
|
|
+ 46, is_sparx5(sparx5) ? 7 : 6);
|
|
/* FWD.SFLOW_ID (disable SFlow sampling) */
|
|
- ifh_encode_bitfield(ifh_hdr, 124, 57, 7);
|
|
+ ifh_encode_bitfield(ifh_hdr, 124, is_sparx5(sparx5) ? 57 : 56, 7);
|
|
/* FWD.UPDATE_FCS = Enable. Enforce update of FCS. */
|
|
- ifh_encode_bitfield(ifh_hdr, 1, 67, 1);
|
|
+ ifh_encode_bitfield(ifh_hdr, 1, is_sparx5(sparx5) ? 67 : 66, 1);
|
|
}
|
|
|
|
void sparx5_set_port_ifh_rew_op(void *ifh_hdr, u32 rew_op)
|
|
@@ -84,19 +84,22 @@ void sparx5_set_port_ifh_rew_op(void *if
|
|
void sparx5_set_port_ifh_pdu_type(struct sparx5 *sparx5, void *ifh_hdr,
|
|
u32 pdu_type)
|
|
{
|
|
- ifh_encode_bitfield(ifh_hdr, pdu_type, 191, 4);
|
|
+ ifh_encode_bitfield(ifh_hdr, pdu_type, is_sparx5(sparx5) ? 191 : 190,
|
|
+ 4);
|
|
}
|
|
|
|
void sparx5_set_port_ifh_pdu_w16_offset(struct sparx5 *sparx5, void *ifh_hdr,
|
|
u32 pdu_w16_offset)
|
|
{
|
|
- ifh_encode_bitfield(ifh_hdr, pdu_w16_offset, 195, 6);
|
|
+ ifh_encode_bitfield(ifh_hdr, pdu_w16_offset,
|
|
+ is_sparx5(sparx5) ? 195 : 194, 6);
|
|
}
|
|
|
|
void sparx5_set_port_ifh_timestamp(struct sparx5 *sparx5, void *ifh_hdr,
|
|
u64 timestamp)
|
|
{
|
|
- ifh_encode_bitfield(ifh_hdr, timestamp, 232, 40);
|
|
+ ifh_encode_bitfield(ifh_hdr, timestamp, 232,
|
|
+ is_sparx5(sparx5) ? 40 : 38);
|
|
}
|
|
|
|
static int sparx5_port_open(struct net_device *ndev)
|
|
--- a/drivers/net/ethernet/microchip/sparx5/sparx5_packet.c
|
|
+++ b/drivers/net/ethernet/microchip/sparx5/sparx5_packet.c
|
|
@@ -43,7 +43,8 @@ void sparx5_ifh_parse(struct sparx5 *spa
|
|
((u32)xtr_hdr[29] << 8) |
|
|
((u32)xtr_hdr[30] << 0);
|
|
fwd = (fwd >> 5);
|
|
- info->src_port = FIELD_GET(GENMASK(7, 1), fwd);
|
|
+ info->src_port = spx5_field_get(GENMASK(is_sparx5(sparx5) ? 7 : 6, 1),
|
|
+ fwd);
|
|
|
|
/*
|
|
* Bit 270-271 are occasionally unexpectedly set by the hardware,
|
|
--- a/drivers/net/ethernet/microchip/sparx5/sparx5_port.c
|
|
+++ b/drivers/net/ethernet/microchip/sparx5/sparx5_port.c
|
|
@@ -476,6 +476,9 @@ static int sparx5_port_fifo_sz(struct sp
|
|
u32 mac_width = 8;
|
|
u32 addition = 0;
|
|
|
|
+ if (!is_sparx5(sparx5))
|
|
+ return 0;
|
|
+
|
|
switch (speed) {
|
|
case SPEED_25000:
|
|
return 0;
|
|
@@ -921,6 +924,20 @@ static int sparx5_port_config_low_set(st
|
|
sparx5,
|
|
DEV2G5_DEV_RST_CTRL(port->portno));
|
|
|
|
+ /* Enable PHAD_CTRL for better timestamping */
|
|
+ if (!is_sparx5(sparx5)) {
|
|
+ for (int i = 0; i < 2; ++i) {
|
|
+ /* Divide the port clock by three for the two
|
|
+ * phase detection registers.
|
|
+ */
|
|
+ spx5_rmw(DEV2G5_PHAD_CTRL_DIV_CFG_SET(3) |
|
|
+ DEV2G5_PHAD_CTRL_PHAD_ENA_SET(1),
|
|
+ DEV2G5_PHAD_CTRL_DIV_CFG |
|
|
+ DEV2G5_PHAD_CTRL_PHAD_ENA,
|
|
+ sparx5, DEV2G5_PHAD_CTRL(port->portno, i));
|
|
+ }
|
|
+ }
|
|
+
|
|
return 0;
|
|
}
|
|
|
|
@@ -978,6 +995,7 @@ int sparx5_port_config(struct sparx5 *sp
|
|
struct sparx5_port_config *conf)
|
|
{
|
|
bool high_speed_dev = sparx5_is_baser(conf->portmode);
|
|
+ const struct sparx5_ops *ops = sparx5->data->ops;
|
|
int err, urgency, stop_wm;
|
|
|
|
err = sparx5_port_verify_speed(sparx5, port, conf);
|
|
@@ -993,6 +1011,13 @@ int sparx5_port_config(struct sparx5 *sp
|
|
if (err)
|
|
return err;
|
|
|
|
+ if (!is_sparx5(sparx5) && ops->is_port_10g(port->portno) &&
|
|
+ conf->speed < SPEED_10000)
|
|
+ spx5_rmw(DSM_DEV_TX_STOP_WM_CFG_DEV10G_SHADOW_ENA_SET(1),
|
|
+ DSM_DEV_TX_STOP_WM_CFG_DEV10G_SHADOW_ENA,
|
|
+ sparx5,
|
|
+ DSM_DEV_TX_STOP_WM_CFG(port->portno));
|
|
+
|
|
/* Set the DSM stop watermark */
|
|
stop_wm = sparx5_port_fifo_sz(sparx5, port->portno, conf->speed);
|
|
spx5_rmw(DSM_DEV_TX_STOP_WM_CFG_DEV_TX_STOP_WM_SET(stop_wm),
|
|
@@ -1144,6 +1169,27 @@ int sparx5_port_init(struct sparx5 *spar
|
|
DEV25G_PCS25G_SD_CFG(pix));
|
|
}
|
|
|
|
+ if (!is_sparx5(sparx5)) {
|
|
+ void __iomem *inst;
|
|
+ u32 dev, tinst;
|
|
+
|
|
+ if (ops->is_port_10g(port->portno)) {
|
|
+ dev = sparx5_to_high_dev(sparx5, port->portno);
|
|
+ tinst = sparx5_port_dev_index(sparx5, port->portno);
|
|
+ inst = spx5_inst_get(sparx5, dev, tinst);
|
|
+
|
|
+ spx5_inst_wr(5, inst,
|
|
+ DEV10G_PTP_STAMPER_CFG(port->portno));
|
|
+ } else if (ops->is_port_5g(port->portno)) {
|
|
+ dev = sparx5_to_high_dev(sparx5, port->portno);
|
|
+ tinst = sparx5_port_dev_index(sparx5, port->portno);
|
|
+ inst = spx5_inst_get(sparx5, dev, tinst);
|
|
+
|
|
+ spx5_inst_wr(5, inst,
|
|
+ DEV5G_PTP_STAMPER_CFG(port->portno));
|
|
+ }
|
|
+ }
|
|
+
|
|
return 0;
|
|
}
|
|
|
|
--- a/drivers/net/ethernet/microchip/sparx5/sparx5_qos.c
|
|
+++ b/drivers/net/ethernet/microchip/sparx5/sparx5_qos.c
|
|
@@ -367,9 +367,10 @@ static u32 sparx5_weight_to_hw_cost(u32
|
|
static int sparx5_dwrr_conf_set(struct sparx5_port *port,
|
|
struct sparx5_dwrr *dwrr)
|
|
{
|
|
+ u32 layer = is_sparx5(port->sparx5) ? 2 : 1;
|
|
int i;
|
|
|
|
- spx5_rmw(HSCH_HSCH_CFG_CFG_HSCH_LAYER_SET(2) |
|
|
+ spx5_rmw(HSCH_HSCH_CFG_CFG_HSCH_LAYER_SET(layer) |
|
|
HSCH_HSCH_CFG_CFG_CFG_SE_IDX_SET(port->portno),
|
|
HSCH_HSCH_CFG_CFG_HSCH_LAYER | HSCH_HSCH_CFG_CFG_CFG_SE_IDX,
|
|
port->sparx5, HSCH_HSCH_CFG_CFG);
|