liumin/test
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases 1 Wiki Activity
Files
2876d77eb547c543477f693a27aef3387ea14a16
test/drivers/source/eth/phy/rtl9010.c
liumin 846bd3bbda 增加所有文件
2025-11-07 20:19:23 +08:00

327 lines
8.6 KiB
C
Raw Blame History

/*
* rtl9010.c
*
* Copyright (c) 2020 Semidrive Semiconductor.
* All rights reserved.
*
* Description: eth phy rtl9010 drv
*
* Revision History:
* -----------------
*/
#include <stdlib.h>
#include "debug.h"
#include "CLI.h"
#include "phy.h"
#define LINK_UP 0
#define LINK_DOWN -100
#define PHY_CLI_EN 1
#if PHY_CLI_EN
static phy_dev_t *g_rtl9010_dev;
#endif
static int rtl9010_read(phy_dev_t *dev, uint32_t regaddr)
{
phy_bus_t *bus = dev->bus;
int ret = bus->ops->mdio_read(bus, dev->phy_addr, 0xFF, regaddr);
if (ret < 0)
ssdk_printf(SSDK_ERR, "rtl9010_read err!\n");
return ret;
}
static int rtl9010_write(phy_dev_t *dev, uint32_t regaddr, uint16_t val)
{
phy_bus_t *bus = dev->bus;
if (bus->ops->mdio_write(bus, dev->phy_addr, 0xFF, regaddr, val)) {
ssdk_printf(SSDK_ERR, "rtl9010_write err!\n");
return -1;
}
return 0;
}
static int rtl9010_initial_config(phy_dev_t *dev)
{
int mdio_data = 0;
int timer = 2000; // set a 2ms timer
// PHY Parameter Start //
rtl9010_write(dev, 31, 0x0BC4);
rtl9010_write(dev, 21, 0x16FE);
rtl9010_write(dev, 27, 0xB820);
rtl9010_write(dev, 28, 0x0010);
rtl9010_write(dev, 27, 0xB830);
rtl9010_write(dev, 28, 0x8000);
rtl9010_write(dev, 27, 0xB800);
mdio_data = (rtl9010_read(dev, 28) & 0x0040);
while (mdio_data != 0x0040) {
rtl9010_write(dev, 27, 0xB800);
mdio_data = (rtl9010_read(dev, 28) & 0x0040);
timer--;
if (timer == 0) {
return -1;
}
}
rtl9010_write(dev, 27, 0x8020);
rtl9010_write(dev, 28, 0x9100);
rtl9010_write(dev, 27, 0xB82E);
rtl9010_write(dev, 28, 0x0001);
rtl9010_write(dev, 27, 0xB820);
rtl9010_write(dev, 28, 0x0290);
rtl9010_write(dev, 27, 0xA012);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0xA014);
rtl9010_write(dev, 28, 0xD700);
rtl9010_write(dev, 28, 0x880F);
rtl9010_write(dev, 28, 0x262D);
rtl9010_write(dev, 27, 0xA01A);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0xA000);
rtl9010_write(dev, 28, 0x162C);
rtl9010_write(dev, 27, 0xB820);
rtl9010_write(dev, 28, 0x0210);
rtl9010_write(dev, 27, 0xB82E);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0x8020);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0xB820);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0xB800);
mdio_data = rtl9010_read(dev, 28) & 0x0040;
timer = 2000; // set a 2ms timer
while (mdio_data != 0x0000) {
rtl9010_write(dev, 27, 0xB800);
mdio_data = (rtl9010_read(dev, 28) & 0x0040);
timer--;
if (timer == 0) {
return -2;
}
}
// End //
/* Set rx delay to 2ns. */
rtl9010_write(dev, 27, 0xD04A);
rtl9010_write(dev, 28, 7);
/* Set tx delay to 2ns. */
rtl9010_write(dev, 27, 0xD084);
rtl9010_write(dev, 28, 0x4007);
rtl9010_write(dev, 0, 0x8000); // PHY soft-reset
mdio_data = 0;
while (mdio_data != 0x0140) { // Check soft-reset complete
mdio_data = rtl9010_read(dev, 0);
}
return 0;
}
static int rtl9010_initial_with_nway_config(phy_dev_t *dev)
{
int mdio_data = 0;
int timer = 2000; // set a 2ms timer
// PHY Parameter Start //
rtl9010_write(dev, 31,0x0A54);
rtl9010_write(dev, 21,0xFA06);
rtl9010_write(dev, 31,0x0BC4);
rtl9010_write(dev, 21,0x16FE);
rtl9010_write(dev, 27, 0xB820);
rtl9010_write(dev, 28, 0x0010);
rtl9010_write(dev, 27, 0xB830);
rtl9010_write(dev, 28, 0x8000);
rtl9010_write(dev, 27, 0xB800);
mdio_data = (rtl9010_read(dev, 28) & 0x0040);
while (mdio_data != 0x0040) {
rtl9010_write(dev, 27, 0xB800);
mdio_data = (rtl9010_read(dev, 28) & 0x0040);
timer--;
if (timer == 0) {
return -1;
}
}
rtl9010_write(dev, 27, 0x8020);
rtl9010_write(dev, 28, 0x9100);
rtl9010_write(dev, 27, 0xB82E);
rtl9010_write(dev, 28, 0x0001);
rtl9010_write(dev, 27, 0xB820);
rtl9010_write(dev, 28, 0x0290);
rtl9010_write(dev, 27, 0xA012);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0xA014);
rtl9010_write(dev, 28, 0x2C03);
rtl9010_write(dev, 28, 0x2C07);
rtl9010_write(dev, 28, 0x2C0B);
rtl9010_write(dev, 28, 0x6054);
rtl9010_write(dev, 28, 0xA701);
rtl9010_write(dev, 28, 0xD500);
rtl9010_write(dev, 28, 0x2108);
rtl9010_write(dev, 28, 0x4054);
rtl9010_write(dev, 28, 0x8701);
rtl9010_write(dev, 28, 0xA74A);
rtl9010_write(dev, 28, 0x20DE);
rtl9010_write(dev, 28, 0xD700);
rtl9010_write(dev, 28, 0x880F);
rtl9010_write(dev, 28, 0x262D);
rtl9010_write(dev, 27, 0xA01A);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0xA004);
rtl9010_write(dev, 28, 0x062C);
rtl9010_write(dev, 27, 0xA002);
rtl9010_write(dev, 28, 0x00DD);
rtl9010_write(dev, 27, 0xA000);
rtl9010_write(dev, 28, 0x7107);
rtl9010_write(dev, 27, 0xB820);
rtl9010_write(dev, 28, 0x0210);
rtl9010_write(dev, 27, 0xB82E);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0x8020);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0xB820);
rtl9010_write(dev, 28, 0x0000);
rtl9010_write(dev, 27, 0xB800);
mdio_data = (rtl9010_read(dev, 28) & 0x0040);
timer = 2000; // set a 2ms timer
while (mdio_data != 0x0000) {
rtl9010_write(dev, 27, 0xB800);
mdio_data = (rtl9010_read(dev, 28) & 0x0040);
timer--;
if (timer == 0) {
return -2;
}
}
// End //
/* Set rx delay to 2ns. */
rtl9010_write(dev, 27, 0xD04A);
rtl9010_write(dev, 28, 7);
/* Set tx delay to 2ns. */
rtl9010_write(dev, 27, 0xD084);
rtl9010_write(dev, 28, 0x4007);
rtl9010_write(dev, 0, 0x8000); // PHY soft-reset
mdio_data = 0;
while (mdio_data != 0x0140) { // Check soft-reset complete
mdio_data = rtl9010_read(dev, 0);
}
return 0;
}
static int rtl9010_get_link_status(phy_dev_t *dev)
{
int mdio_data = 0;
int locok = 0;
int remok = 0;
int link_status = 0;
int pcs_status;
int pcs_status_checkOK=0;
mdio_data = rtl9010_read(dev, 1);
mdio_data = rtl9010_read(dev, 1);//Read twice for current link status.
link_status = (mdio_data & 0x0004);
rtl9010_write(dev, 31, 0x0A60);
mdio_data = rtl9010_read(dev, 16);
pcs_status = (mdio_data & 0x00FF);
if (dev->speed == PHY_SPEED_1000){
mdio_data = rtl9010_read(dev, 10);
locok = ((mdio_data & 0x2000) == 0x2000);
remok = ((mdio_data & 0x1000) == 0x1000);
if (pcs_status == 0x0037)
pcs_status_checkOK = 1;
}
else {
rtl9010_write(dev, 31, 0x0A64);
mdio_data = rtl9010_read(dev, 23);
locok = ((mdio_data & 0x0004) == 0x0004);
remok = ((mdio_data & 0x0400) == 0x0400);
if (pcs_status == 0x0044)
pcs_status_checkOK = 1;
}
ssdk_printf(SSDK_INFO, "link_status = 0x%04X\r\n",link_status);
ssdk_printf(SSDK_INFO, "locok = 0x%04X\r\n",locok);
ssdk_printf(SSDK_INFO, "remok = 0x%04X\r\n",remok);
ssdk_printf(SSDK_INFO, "pcs_status = 0x%04X\r\n",pcs_status);
if ((link_status == 0x0004) & (locok) & (remok) &
pcs_status_checkOK)
return LINK_UP;
else
return LINK_DOWN;
}
int rtl9010_init(phy_dev_t *dev)
{
int ret = 0, timeout = 1000;
#if PHY_CLI_EN
g_rtl9010_dev = dev;
#endif
if (dev->auto_negotiation)
ret = rtl9010_initial_with_nway_config(dev);
else
ret = rtl9010_initial_config(dev);
if (!ret && dev->auto_negotiation) {
ssdk_printf(SSDK_EMERG, "Wait for rtl9010 link ...\n");
while (timeout--) {
ret = rtl9010_get_link_status(dev);
if (ret == LINK_UP) {
ssdk_printf(SSDK_EMERG, "Link successfully\n");
return ret;
}
}
ssdk_printf(SSDK_EMERG, "Link failed\n");
}
return ret;
}
#if PHY_CLI_EN
static int rtl9010_dump(int argc, char *argv[])
{
if (!g_rtl9010_dev) {
printf("rtl9010 is not availiable\n");
return 0;
}
if (argc == 0) {
printf("phy <reg_num> [val]\n");
return 0;
}
int reg_num = strtoul(argv[0], NULL, 0);
if (argc == 1)
printf("read reg %d: 0x%x\n", reg_num, rtl9010_read(g_rtl9010_dev, reg_num));
else {
int val = strtoul(argv[1], NULL, 0);
printf("write reg %d val 0x%x result %d\n", reg_num, val,
rtl9010_write(g_rtl9010_dev, reg_num, val));
}
return 0;
}
CLI_CMD("rtl", "\r\nrtl:\r\n rtl reg dump\r\n", rtl9010_dump);
#endif
Reference in New Issue View Git Blame Copy Permalink