96 lines
3.3 KiB
C
96 lines
3.3 KiB
C
|
// SPDX-License-Identifier: GPL-2.0+
|
||
|
|
#include <linux/linkmode.h>
|
||
|
|
|
||
|
|
/**
|
||
|
|
* linkmode_resolve_pause - resolve the allowable pause modes
|
||
|
|
* @local_adv: local advertisement in ethtool format
|
||
|
|
* @partner_adv: partner advertisement in ethtool format
|
||
|
|
* @tx_pause: pointer to bool to indicate whether transmit pause should be
|
||
|
|
* enabled.
|
||
|
|
* @rx_pause: pointer to bool to indicate whether receive pause should be
|
||
|
|
* enabled.
|
||
|
|
*
|
||
|
|
* Flow control is resolved according to our and the link partners
|
||
|
|
* advertisements using the following drawn from the 802.3 specs:
|
||
|
|
* Local device Link partner
|
||
|
|
* Pause AsymDir Pause AsymDir Result
|
||
|
|
* 0 X 0 X Disabled
|
||
|
|
* 0 1 1 0 Disabled
|
||
|
|
* 0 1 1 1 TX
|
||
|
|
* 1 0 0 X Disabled
|
||
|
|
* 1 X 1 X TX+RX
|
||
|
|
* 1 1 0 1 RX
|
||
|
|
*/
|
||
|
|
void linkmode_resolve_pause(const unsigned long *local_adv,
|
||
|
|
const unsigned long *partner_adv,
|
||
|
|
bool *tx_pause, bool *rx_pause)
|
||
|
|
{
|
||
|
|
__ETHTOOL_DECLARE_LINK_MODE_MASK(m);
|
||
|
|
|
||
|
|
linkmode_and(m, local_adv, partner_adv);
|
||
|
|
if (linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, m)) {
|
||
|
|
*tx_pause = true;
|
||
|
|
*rx_pause = true;
|
||
|
|
} else if (linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, m)) {
|
||
|
|
*tx_pause = linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT,
|
||
|
|
partner_adv);
|
||
|
|
*rx_pause = linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT,
|
||
|
|
local_adv);
|
||
|
|
} else {
|
||
|
|
*tx_pause = false;
|
||
|
|
*rx_pause = false;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(linkmode_resolve_pause);
|
||
|
|
|
||
|
|
/**
|
||
|
|
* linkmode_set_pause - set the pause mode advertisement
|
||
|
|
* @advertisement: advertisement in ethtool format
|
||
|
|
* @tx: boolean from ethtool struct ethtool_pauseparam tx_pause member
|
||
|
|
* @rx: boolean from ethtool struct ethtool_pauseparam rx_pause member
|
||
|
|
*
|
||
|
|
* Configure the advertised Pause and Asym_Pause bits according to the
|
||
|
|
* capabilities of provided in @tx and @rx.
|
||
|
|
*
|
||
|
|
* We convert as follows:
|
||
|
|
* tx rx Pause AsymDir
|
||
|
|
* 0 0 0 0
|
||
|
|
* 0 1 1 1
|
||
|
|
* 1 0 0 1
|
||
|
|
* 1 1 1 0
|
||
|
|
*
|
||
|
|
* Note: this translation from ethtool tx/rx notation to the advertisement
|
||
|
|
* is actually very problematical. Here are some examples:
|
||
|
|
*
|
||
|
|
* For tx=0 rx=1, meaning transmit is unsupported, receive is supported:
|
||
|
|
*
|
||
|
|
* Local device Link partner
|
||
|
|
* Pause AsymDir Pause AsymDir Result
|
||
|
|
* 1 1 1 0 TX + RX - but we have no TX support.
|
||
|
|
* 1 1 0 1 Only this gives RX only
|
||
|
|
*
|
||
|
|
* For tx=1 rx=1, meaning we have the capability to transmit and receive
|
||
|
|
* pause frames:
|
||
|
|
*
|
||
|
|
* Local device Link partner
|
||
|
|
* Pause AsymDir Pause AsymDir Result
|
||
|
|
* 1 0 0 1 Disabled - but since we do support tx and rx,
|
||
|
|
* this should resolve to RX only.
|
||
|
|
*
|
||
|
|
* Hence, asking for:
|
||
|
|
* rx=1 tx=0 gives Pause+AsymDir advertisement, but we may end up
|
||
|
|
* resolving to tx+rx pause or only rx pause depending on
|
||
|
|
* the partners advertisement.
|
||
|
|
* rx=0 tx=1 gives AsymDir only, which will only give tx pause if
|
||
|
|
* the partners advertisement allows it.
|
||
|
|
* rx=1 tx=1 gives Pause only, which will only allow tx+rx pause
|
||
|
|
* if the other end also advertises Pause.
|
||
|
|
*/
|
||
|
|
void linkmode_set_pause(unsigned long *advertisement, bool tx, bool rx)
|
||
|
|
{
|
||
|
|
linkmode_mod_bit(ETHTOOL_LINK_MODE_Pause_BIT, advertisement, rx);
|
||
|
|
linkmode_mod_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, advertisement,
|
||
|
|
rx ^ tx);
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_GPL(linkmode_set_pause);
|