From 7aefde9f66d43ab222f8f9975e291d0f922a1bf6 Mon Sep 17 00:00:00 2001 From: Gabor Juhos Date: Wed, 20 Jan 2010 20:36:30 +0000 Subject: [PATCH] rtl8366_smi: simplify rtl8366_attr_get_port_link function SVN-Revision: 19250 --- .../files/drivers/net/phy/rtl8366_smi.c | 85 +++++++------------ 1 file changed, 33 insertions(+), 52 deletions(-) diff --git a/target/linux/ar71xx/files/drivers/net/phy/rtl8366_smi.c b/target/linux/ar71xx/files/drivers/net/phy/rtl8366_smi.c index 20510724c5..fe16591333 100644 --- a/target/linux/ar71xx/files/drivers/net/phy/rtl8366_smi.c +++ b/target/linux/ar71xx/files/drivers/net/phy/rtl8366_smi.c @@ -1275,71 +1275,52 @@ static int rtl8366_set_vlan(struct switch_dev *dev, return rtl8366_vlan_set_4ktable(smi, val->value.i); } +static const char *rtl8366_speed_str(unsigned speed) +{ + switch (speed) { + case 0: + return "10baseT"; + case 1: + return "100baseT"; + case 2: + return "1000baseT"; + } + + return "unknown"; +} + static int rtl8366_attr_get_port_link(struct switch_dev *dev, const struct switch_attr *attr, struct switch_val *val) { - u32 len = 0, data = 0; - int speed, duplex, link, txpause, rxpause, nway; struct rtl8366_smi *smi = sw_to_rtl8366(dev); - char *buf = smi->buf; + u32 len = 0, data = 0; if (val->port_vlan >= RTL8366_NUM_PORTS) return -EINVAL; - memset(buf, '\0', sizeof(smi->buf)); + memset(smi->buf, '\0', sizeof(smi->buf)); rtl8366_smi_read_reg(smi, RTL8366S_PORT_LINK_STATUS_BASE + - (val->port_vlan >> 1), - &data); + (val->port_vlan / 2), &data); - if (val->port_vlan & 0x1) + if (val->port_vlan % 2) data = data >> 8; - speed = (data & RTL8366S_PORT_STATUS_SPEED_MASK); - duplex = (data & RTL8366S_PORT_STATUS_DUPLEX_MASK) >> 2; - link = (data & RTL8366S_PORT_STATUS_LINK_MASK) >> 4; - txpause = (data & RTL8366S_PORT_STATUS_TXPAUSE_MASK) >> 5; - rxpause = (data & RTL8366S_PORT_STATUS_RXPAUSE_MASK) >> 6; - nway = (data & RTL8366S_PORT_STATUS_AN_MASK) >> 7; - - len += snprintf(buf + len, sizeof(smi->buf) - len, "Port %d: ", - val->port_vlan); - - if (link) - len += snprintf(buf + len, sizeof(smi->buf) - len, - "Link UP, Speed: "); - else - len += snprintf(buf + len, sizeof(smi->buf) - len, - "Link DOWN, Speed: "); - - if (speed == 0) - len += snprintf(buf + len, sizeof(smi->buf) - len, - "10Base-TX "); - else if (speed == 1) - len += snprintf(buf + len, sizeof(smi->buf) - len, - "100Base-TX "); - else if (speed == 2) - len += snprintf(buf + len, sizeof(smi->buf) - len, - "1000Base-TX "); - - if (duplex) - len += snprintf(buf + len, sizeof(smi->buf) - len, - "Full-Duplex, "); - else - len += snprintf(buf + len, sizeof(smi->buf) - len, - "Half-Duplex, "); - - if (txpause) - len += snprintf(buf + len, sizeof(smi->buf) - len, - "TX-Pause "); - if (rxpause) - len += snprintf(buf + len, sizeof(smi->buf) - len, - "RX-Pause "); - if (nway) - len += snprintf(buf + len, sizeof(smi->buf) - len, - "nway "); - - val->value.s = buf; + len = snprintf(smi->buf, sizeof(smi->buf), + "port:%d link:%s speed:%s %s-duplex %s%s%s", + val->port_vlan, + (data & RTL8366S_PORT_STATUS_LINK_MASK) ? "up" : "down", + rtl8366_speed_str(data & + RTL8366S_PORT_STATUS_SPEED_MASK), + (data & RTL8366S_PORT_STATUS_DUPLEX_MASK) ? + "full" : "half", + (data & RTL8366S_PORT_STATUS_TXPAUSE_MASK) ? + "tx-pause ": "", + (data & RTL8366S_PORT_STATUS_RXPAUSE_MASK) ? + "rx-pause " : "", + (data & RTL8366S_PORT_STATUS_AN_MASK) ? "nway ": ""); + + val->value.s = smi->buf; val->len = len; return 0; -- 2.25.1