mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-08-10 17:26:59 +02:00
d678a59d2d
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay Ethernet"' I failed to notice that b4 noticed it was based on next and so took that as the base commit and merged that part of next to master. This reverts commitc8ffd1356d, reversing changes made to2ee6f3a5f7. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
129 lines
3.3 KiB
C
129 lines
3.3 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Aspeed MDIO driver
|
|
*
|
|
* (C) Copyright 2021 Aspeed Technology Inc.
|
|
*
|
|
* This file is inspired from the Linux kernel driver drivers/net/phy/mdio-aspeed.c
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <log.h>
|
|
#include <miiphy.h>
|
|
#include <net.h>
|
|
#include <reset.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/bitfield.h>
|
|
#include <linux/io.h>
|
|
#include <linux/iopoll.h>
|
|
|
|
#define ASPEED_MDIO_CTRL 0x0
|
|
#define ASPEED_MDIO_CTRL_FIRE BIT(31)
|
|
#define ASPEED_MDIO_CTRL_ST BIT(28)
|
|
#define ASPEED_MDIO_CTRL_ST_C45 0
|
|
#define ASPEED_MDIO_CTRL_ST_C22 1
|
|
#define ASPEED_MDIO_CTRL_OP GENMASK(27, 26)
|
|
#define MDIO_C22_OP_WRITE 0b01
|
|
#define MDIO_C22_OP_READ 0b10
|
|
#define ASPEED_MDIO_CTRL_PHYAD GENMASK(25, 21)
|
|
#define ASPEED_MDIO_CTRL_REGAD GENMASK(20, 16)
|
|
#define ASPEED_MDIO_CTRL_MIIWDATA GENMASK(15, 0)
|
|
|
|
#define ASPEED_MDIO_DATA 0x4
|
|
#define ASPEED_MDIO_DATA_MDC_THRES GENMASK(31, 24)
|
|
#define ASPEED_MDIO_DATA_MDIO_EDGE BIT(23)
|
|
#define ASPEED_MDIO_DATA_MDIO_LATCH GENMASK(22, 20)
|
|
#define ASPEED_MDIO_DATA_IDLE BIT(16)
|
|
#define ASPEED_MDIO_DATA_MIIRDATA GENMASK(15, 0)
|
|
|
|
#define ASPEED_MDIO_TIMEOUT_US 1000
|
|
|
|
struct aspeed_mdio_priv {
|
|
void *base;
|
|
};
|
|
|
|
static int aspeed_mdio_read(struct udevice *mdio_dev, int addr, int devad, int reg)
|
|
{
|
|
struct aspeed_mdio_priv *priv = dev_get_priv(mdio_dev);
|
|
u32 ctrl;
|
|
u32 data;
|
|
int rc;
|
|
|
|
if (devad != MDIO_DEVAD_NONE)
|
|
return -EOPNOTSUPP;
|
|
|
|
ctrl = ASPEED_MDIO_CTRL_FIRE
|
|
| FIELD_PREP(ASPEED_MDIO_CTRL_ST, ASPEED_MDIO_CTRL_ST_C22)
|
|
| FIELD_PREP(ASPEED_MDIO_CTRL_OP, MDIO_C22_OP_READ)
|
|
| FIELD_PREP(ASPEED_MDIO_CTRL_PHYAD, addr)
|
|
| FIELD_PREP(ASPEED_MDIO_CTRL_REGAD, reg);
|
|
|
|
writel(ctrl, priv->base + ASPEED_MDIO_CTRL);
|
|
|
|
rc = readl_poll_timeout(priv->base + ASPEED_MDIO_DATA, data,
|
|
data & ASPEED_MDIO_DATA_IDLE,
|
|
ASPEED_MDIO_TIMEOUT_US);
|
|
|
|
if (rc < 0)
|
|
return rc;
|
|
|
|
return FIELD_GET(ASPEED_MDIO_DATA_MIIRDATA, data);
|
|
}
|
|
|
|
static int aspeed_mdio_write(struct udevice *mdio_dev, int addr, int devad, int reg, u16 val)
|
|
{
|
|
struct aspeed_mdio_priv *priv = dev_get_priv(mdio_dev);
|
|
u32 ctrl;
|
|
|
|
if (devad != MDIO_DEVAD_NONE)
|
|
return -EOPNOTSUPP;
|
|
|
|
ctrl = ASPEED_MDIO_CTRL_FIRE
|
|
| FIELD_PREP(ASPEED_MDIO_CTRL_ST, ASPEED_MDIO_CTRL_ST_C22)
|
|
| FIELD_PREP(ASPEED_MDIO_CTRL_OP, MDIO_C22_OP_WRITE)
|
|
| FIELD_PREP(ASPEED_MDIO_CTRL_PHYAD, addr)
|
|
| FIELD_PREP(ASPEED_MDIO_CTRL_REGAD, reg)
|
|
| FIELD_PREP(ASPEED_MDIO_CTRL_MIIWDATA, val);
|
|
|
|
writel(ctrl, priv->base + ASPEED_MDIO_CTRL);
|
|
|
|
return readl_poll_timeout(priv->base + ASPEED_MDIO_CTRL, ctrl,
|
|
!(ctrl & ASPEED_MDIO_CTRL_FIRE),
|
|
ASPEED_MDIO_TIMEOUT_US);
|
|
}
|
|
|
|
static const struct mdio_ops aspeed_mdio_ops = {
|
|
.read = aspeed_mdio_read,
|
|
.write = aspeed_mdio_write,
|
|
};
|
|
|
|
static int aspeed_mdio_probe(struct udevice *dev)
|
|
{
|
|
struct aspeed_mdio_priv *priv = dev_get_priv(dev);
|
|
struct reset_ctl reset_ctl;
|
|
int ret = 0;
|
|
|
|
priv->base = dev_read_addr_ptr(dev);
|
|
|
|
ret = reset_get_by_index(dev, 0, &reset_ctl);
|
|
reset_deassert(&reset_ctl);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct udevice_id aspeed_mdio_ids[] = {
|
|
{ .compatible = "aspeed,ast2600-mdio" },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(aspeed_mdio) = {
|
|
.name = "aspeed_mdio",
|
|
.id = UCLASS_MDIO,
|
|
.of_match = aspeed_mdio_ids,
|
|
.probe = aspeed_mdio_probe,
|
|
.ops = &aspeed_mdio_ops,
|
|
.plat_auto = sizeof(struct mdio_perdev_priv),
|
|
.priv_auto = sizeof(struct aspeed_mdio_priv),
|
|
};
|