You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
168 lines
4.0 KiB
168 lines
4.0 KiB
/* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; version 2 of the License
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* Copyright (C) 2009-2015 John Crispin <blogic@openwrt.org>
|
|
* Copyright (C) 2009-2015 Felix Fietkau <nbd@nbd.name>
|
|
* Copyright (C) 2013-2015 Michael Lee <igvtee@gmail.com>
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/types.h>
|
|
|
|
#include "mtk_eth_soc.h"
|
|
#include "gsw_mt7620.h"
|
|
#include "mdio.h"
|
|
|
|
static int mt7620_mii_busy_wait(struct mt7620_gsw *gsw)
|
|
{
|
|
unsigned long t_start = jiffies;
|
|
|
|
while (1) {
|
|
if (!(mtk_switch_r32(gsw, MT7620A_GSW_REG_PIAC) & GSW_MDIO_ACCESS))
|
|
return 0;
|
|
if (time_after(jiffies, t_start + GSW_REG_PHY_TIMEOUT))
|
|
break;
|
|
}
|
|
|
|
dev_err(gsw->dev, "mdio: MDIO timeout\n");
|
|
return -1;
|
|
}
|
|
|
|
u32 _mt7620_mii_write(struct mt7620_gsw *gsw, u32 phy_addr,
|
|
u32 phy_register, u32 write_data)
|
|
{
|
|
if (mt7620_mii_busy_wait(gsw))
|
|
return -1;
|
|
|
|
write_data &= 0xffff;
|
|
|
|
mtk_switch_w32(gsw, GSW_MDIO_ACCESS | GSW_MDIO_START | GSW_MDIO_WRITE |
|
|
(phy_register << GSW_MDIO_REG_SHIFT) |
|
|
(phy_addr << GSW_MDIO_ADDR_SHIFT) | write_data,
|
|
MT7620A_GSW_REG_PIAC);
|
|
|
|
if (mt7620_mii_busy_wait(gsw))
|
|
return -1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
u32 _mt7620_mii_read(struct mt7620_gsw *gsw, int phy_addr, int phy_reg)
|
|
{
|
|
u32 d;
|
|
|
|
if (mt7620_mii_busy_wait(gsw))
|
|
return 0xffff;
|
|
|
|
mtk_switch_w32(gsw, GSW_MDIO_ACCESS | GSW_MDIO_START | GSW_MDIO_READ |
|
|
(phy_reg << GSW_MDIO_REG_SHIFT) |
|
|
(phy_addr << GSW_MDIO_ADDR_SHIFT),
|
|
MT7620A_GSW_REG_PIAC);
|
|
|
|
if (mt7620_mii_busy_wait(gsw))
|
|
return 0xffff;
|
|
|
|
d = mtk_switch_r32(gsw, MT7620A_GSW_REG_PIAC) & 0xffff;
|
|
|
|
return d;
|
|
}
|
|
|
|
int mt7620_mdio_write(struct mii_bus *bus, int phy_addr, int phy_reg, u16 val)
|
|
{
|
|
struct fe_priv *priv = bus->priv;
|
|
struct mt7620_gsw *gsw = (struct mt7620_gsw *)priv->soc->swpriv;
|
|
|
|
return _mt7620_mii_write(gsw, phy_addr, phy_reg, val);
|
|
}
|
|
|
|
int mt7620_mdio_read(struct mii_bus *bus, int phy_addr, int phy_reg)
|
|
{
|
|
struct fe_priv *priv = bus->priv;
|
|
struct mt7620_gsw *gsw = (struct mt7620_gsw *)priv->soc->swpriv;
|
|
|
|
return _mt7620_mii_read(gsw, phy_addr, phy_reg);
|
|
}
|
|
|
|
void mt7530_mdio_w32(struct mt7620_gsw *gsw, u32 reg, u32 val)
|
|
{
|
|
_mt7620_mii_write(gsw, 0x1f, 0x1f, (reg >> 6) & 0x3ff);
|
|
_mt7620_mii_write(gsw, 0x1f, (reg >> 2) & 0xf, val & 0xffff);
|
|
_mt7620_mii_write(gsw, 0x1f, 0x10, val >> 16);
|
|
}
|
|
|
|
u32 mt7530_mdio_r32(struct mt7620_gsw *gsw, u32 reg)
|
|
{
|
|
u16 high, low;
|
|
|
|
_mt7620_mii_write(gsw, 0x1f, 0x1f, (reg >> 6) & 0x3ff);
|
|
low = _mt7620_mii_read(gsw, 0x1f, (reg >> 2) & 0xf);
|
|
high = _mt7620_mii_read(gsw, 0x1f, 0x10);
|
|
|
|
return (high << 16) | (low & 0xffff);
|
|
}
|
|
|
|
static unsigned char *fe_speed_str(int speed)
|
|
{
|
|
switch (speed) {
|
|
case 2:
|
|
case SPEED_1000:
|
|
return "1000";
|
|
case 1:
|
|
case SPEED_100:
|
|
return "100";
|
|
case 0:
|
|
case SPEED_10:
|
|
return "10";
|
|
}
|
|
|
|
return "? ";
|
|
}
|
|
|
|
int mt7620_has_carrier(struct fe_priv *priv)
|
|
{
|
|
struct mt7620_gsw *gsw = (struct mt7620_gsw *)priv->soc->swpriv;
|
|
int i;
|
|
|
|
for (i = 0; i < GSW_PORT6; i++)
|
|
if (mtk_switch_r32(gsw, GSW_REG_PORT_STATUS(i)) & 0x1)
|
|
return 1;
|
|
return 0;
|
|
}
|
|
|
|
|
|
void mt7620_handle_carrier(struct fe_priv *priv)
|
|
{
|
|
if (!priv->phy)
|
|
return;
|
|
|
|
if (mt7620_has_carrier(priv))
|
|
netif_carrier_on(priv->netdev);
|
|
else
|
|
netif_carrier_off(priv->netdev);
|
|
}
|
|
|
|
void mt7620_print_link_state(struct fe_priv *priv, int port, int link,
|
|
int speed, int duplex)
|
|
{
|
|
if (link)
|
|
netdev_info(priv->netdev, "port %d link up (%sMbps/%s duplex)\n",
|
|
port, fe_speed_str(speed),
|
|
(duplex) ? "Full" : "Half");
|
|
else
|
|
netdev_info(priv->netdev, "port %d link down\n", port);
|
|
}
|
|
|
|
void mt7620_mdio_link_adjust(struct fe_priv *priv, int port)
|
|
{
|
|
mt7620_print_link_state(priv, port, priv->link[port],
|
|
priv->phy->speed[port],
|
|
(priv->phy->duplex[port] == DUPLEX_FULL));
|
|
mt7620_handle_carrier(priv);
|
|
}
|
|
|