@@ -300,6 +300,7 @@ struct ar7240sw {
u8 vlan_tagged;
u16 pvid[AR7240_NUM_PORTS];
char buf[80];
+ u8 link;
rwlock_t stats_lock;
struct ar7240sw_port_stat port_stats[AR7240_NUM_PORTS];
@@ -1136,9 +1137,31 @@ static void link_function(struct work_struct *work) {
continue;
link = ar7240sw_phy_read(ag->mii_bus, i, MII_BMSR);
- if (link & BMSR_LSTATUS) {
+ link &= BMSR_LSTATUS;
+ link = !!link;
+
+ if (link && !status)
status = 1;
- break;
+
+ if ((!!(as->link & BIT(i))) != link) {
+ struct switch_port_link swlink;
+ int port = i + 1;
+ memset(&swlink, '0', sizeof(swlink));
+ /* link change */
+ if (link) {
+ as->link |= BIT(i);
+ as->swdev.ops->get_port_link(&as->swdev, port, &swlink);
+ pr_info("switch %s port %d: link %s Mbit duplex: %s\n",
+ as->swdev.netdev ? as->swdev.netdev->name : as->swdev.alias,
+ port,
+ swconfig_speed_str(swlink.speed),
+ swlink.duplex ? "full" : "half");
+ } else {
+ as->link &= ~BIT(i);
+ pr_info("switch %s port %d: link down\n",
+ as->swdev.netdev ? as->swdev.netdev->name : as->swdev.alias,
+ port);
+ }
}
}