--- zzzz-none-000/linux-3.10.107/drivers/net/phy/mdio-bitbang.c 2017-06-27 09:49:32.000000000 +0000 +++ scorpion-7490-727/linux-3.10.107/drivers/net/phy/mdio-bitbang.c 2021-02-04 17:41:59.000000000 +0000 @@ -17,6 +17,7 @@ * kind, whether express or implied. */ +#include #include #include #include @@ -155,8 +156,10 @@ static int mdiobb_read(struct mii_bus *bus, int phy, int reg) { struct mdiobb_ctrl *ctrl = bus->priv; - int ret, i; + int ret; + long flags; + local_irq_save(flags); if (reg & MII_ADDR_C45) { reg = mdiobb_cmd_addr(ctrl, phy, reg); mdiobb_cmd(ctrl, MDIO_C45_READ, phy, reg); @@ -165,26 +168,21 @@ ctrl->ops->set_mdio_dir(ctrl, 0); - /* check the turnaround bit: the PHY should be driving it to zero */ - if (mdiobb_get_bit(ctrl) != 0) { - /* PHY didn't drive TA low -- flush any bits it - * may be trying to send. - */ - for (i = 0; i < 32; i++) - mdiobb_get_bit(ctrl); - - return 0xffff; - } + mdiobb_get_bit(ctrl); ret = mdiobb_get_num(ctrl, 16); mdiobb_get_bit(ctrl); + local_irq_restore(flags); + return ret; } static int mdiobb_write(struct mii_bus *bus, int phy, int reg, u16 val) { struct mdiobb_ctrl *ctrl = bus->priv; + unsigned long flags; + local_irq_save(flags); if (reg & MII_ADDR_C45) { reg = mdiobb_cmd_addr(ctrl, phy, reg); mdiobb_cmd(ctrl, MDIO_C45_WRITE, phy, reg); @@ -199,6 +197,8 @@ ctrl->ops->set_mdio_dir(ctrl, 0); mdiobb_get_bit(ctrl); + local_irq_restore(flags); + return 0; }