88 lines
1.6 KiB
C
88 lines
1.6 KiB
C
/*
|
|
* Copyright (c) 2016 - 2021, Broadcom
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
#include <string.h>
|
|
|
|
#include <platform_def.h>
|
|
|
|
#include <common/debug.h>
|
|
#include <drivers/delay_timer.h>
|
|
#include <lib/mmio.h>
|
|
#include <mdio.h>
|
|
|
|
static int mdio_op_status(uint32_t result)
|
|
{
|
|
uint32_t timeout = 1000000U; /* loop for 1s */
|
|
uint32_t val;
|
|
|
|
do {
|
|
val = mmio_read_32(CMIC_MIIM_STAT);
|
|
if ((val & MDIO_STAT_DONE) == result) {
|
|
return 0;
|
|
}
|
|
|
|
udelay(1U);
|
|
} while (timeout-- != 0U);
|
|
return -1;
|
|
}
|
|
|
|
static int mdio_op(uint16_t busid, uint16_t phyid, uint32_t reg,
|
|
uint16_t val, uint8_t op)
|
|
{
|
|
uint32_t param;
|
|
int ret;
|
|
|
|
mmio_write_32(CMIC_MIIM_CTRL, 0U);
|
|
ret = mdio_op_status(0U);
|
|
if (ret != 0) {
|
|
goto err;
|
|
}
|
|
|
|
param = 0U;
|
|
param |= 1U << MDIO_PARAM_INTERNAL_SEL;
|
|
param |= (busid & MDIO_PARAM_BUSID_MASK) << MDIO_PARAM_BUSID;
|
|
param |= (phyid & MDIO_PARAM_PHYID_MASK) << MDIO_PARAM_PHYID;
|
|
param |= (val & MDIO_PARAM_DATA_MASK) << MDIO_PARAM_DATA;
|
|
|
|
mmio_write_32(CMIC_MIIM_PARAM, param);
|
|
|
|
mmio_write_32(CMIC_MIIM_ADDRESS, reg);
|
|
|
|
mmio_write_32(CMIC_MIIM_CTRL, op);
|
|
|
|
ret = mdio_op_status(1U);
|
|
if (ret != 0) {
|
|
goto err;
|
|
}
|
|
|
|
if (op == MDIO_CTRL_READ_OP) {
|
|
ret = mmio_read_32(CMIC_MIIM_READ_DATA) & MDIO_READ_DATA_MASK;
|
|
}
|
|
err:
|
|
return ret;
|
|
}
|
|
|
|
int mdio_write(uint16_t busid, uint16_t phyid, uint32_t reg, uint16_t val)
|
|
{
|
|
int ret;
|
|
|
|
ret = mdio_op(busid, phyid, reg, val, MDIO_CTRL_WRITE_OP);
|
|
if (ret == -1) {
|
|
INFO("MDIO write fail\n");
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
int mdio_read(uint16_t busid, uint16_t phyid, uint32_t reg)
|
|
{
|
|
int ret;
|
|
|
|
ret = mdio_op(busid, phyid, reg, 0U, MDIO_CTRL_READ_OP);
|
|
if (ret == -1) {
|
|
INFO("MDIO read fail\n");
|
|
}
|
|
return ret;
|
|
}
|