github-mirror/linux
1
0
Fork 0
mirror of https://github.com/torvalds/linux.git synced 2026-07-30 19:21:28 +02:00
Code Issues Actions Packages Projects Releases Wiki Activity Graph

net: mvmdio: Support setting the MDC frequency on XSMI controllers

Browse Source 
Support the standard "clock-frequency" attribute to set the generated
MDC frequency. If not specified, the driver will leave the divisor
untouched.

Signed-off-by: Tobias Waldekranz <tobias@waldekranz.com>
Reviewed-by: Andrew Lunn <andrew@lunn.ch>
Tested-by: Andrew Lunn <andrew@lunn.ch>
Link: https://lore.kernel.org/r/20231204100811.2708884-4-tobias@waldekranz.com
Signed-off-by: Jakub Kicinski <kuba@kernel.org>
This commit is contained in:
Tobias Waldekranz 2023-12-04 11:08:11 +01:00 committed by Jakub Kicinski
parent 7dd12fe346
commit eb6a6605ff
1 changed files with 44 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

44
drivers/net/ethernet/marvell/mvmdio.c
View File

@ -53,6 +53,13 @@
#define MVMDIO_XSMI_BUSY BIT(30)
#define MVMDIO_XSMI_ADDR_REG 0x8
#define MVMDIO_XSMI_CFG_REG 0xc
#define MVMDIO_XSMI_CLKDIV_MASK 0x3
#define MVMDIO_XSMI_CLKDIV_256 0x0
#define MVMDIO_XSMI_CLKDIV_64 0x1
#define MVMDIO_XSMI_CLKDIV_32 0x2
#define MVMDIO_XSMI_CLKDIV_8 0x3
/*
* SMI Timeout measurements:
* - Kirkwood 88F6281 (Globalscale Dreamplug): 45us to 95us (Interrupt)
@ -225,6 +232,40 @@ static int orion_mdio_xsmi_write_c45(struct mii_bus *bus, int mii_id,
return 0;
}
static void orion_mdio_xsmi_set_mdc_freq(struct mii_bus *bus)
{
struct orion_mdio_dev *dev = bus->priv;
struct clk *mg_core;
u32 div, freq, cfg;
if (device_property_read_u32(bus->parent, "clock-frequency", &freq))
return;
mg_core = of_clk_get_by_name(bus->parent->of_node, "mg_core_clk");
if (IS_ERR(mg_core)) {
dev_err(bus->parent,
"MG core clock unknown, not changing MDC frequency");
return;
}
div = clk_get_rate(mg_core) / (freq + 1) + 1;
clk_put(mg_core);
if (div <= 8)
div = MVMDIO_XSMI_CLKDIV_8;
else if (div <= 32)
div = MVMDIO_XSMI_CLKDIV_32;
else if (div <= 64)
div = MVMDIO_XSMI_CLKDIV_64;
else
div = MVMDIO_XSMI_CLKDIV_256;
cfg = readl(dev->regs + MVMDIO_XSMI_CFG_REG);
cfg &= ~MVMDIO_XSMI_CLKDIV_MASK;
cfg |= div;
writel(cfg, dev->regs + MVMDIO_XSMI_CFG_REG);
}
static irqreturn_t orion_mdio_err_irq(int irq, void *dev_id)
{
struct orion_mdio_dev *dev = dev_id;
@ -303,6 +344,9 @@ static int orion_mdio_probe(struct platform_device *pdev)
dev_warn(&pdev->dev,
"unsupported number of clocks, limiting to the first "
__stringify(ARRAY_SIZE(dev->clk)) "\n");
if (type == BUS_TYPE_XSMI)
orion_mdio_xsmi_set_mdc_freq(bus);
} else {
dev->clk[0] = clk_get(&pdev->dev, NULL);
if (PTR_ERR(dev->clk[0]) == -EPROBE_DEFER) {