1 // SPDX-License-Identifier: GPL-2.0+
2 #include <linux/linkmode.h>
3
4 /**
5 * linkmode_resolve_pause - resolve the allowable pause modes
6 * @local_adv: local advertisement in ethtool format
7 * @partner_adv: partner advertisement in ethtool format
8 * @tx_pause: pointer to bool to indicate whether transmit pause should be
9 * enabled.
10 * @rx_pause: pointer to bool to indicate whether receive pause should be
11 * enabled.
12 *
13 * Flow control is resolved according to our and the link partners
14 * advertisements using the following drawn from the 802.3 specs:
15 * Local device Link partner
16 * Pause AsymDir Pause AsymDir Result
17 * 0 X 0 X Disabled
18 * 0 1 1 0 Disabled
19 * 0 1 1 1 TX
20 * 1 0 0 X Disabled
21 * 1 X 1 X TX+RX
22 * 1 1 0 1 RX
23 */
linkmode_resolve_pause(const unsigned long * local_adv,const unsigned long * partner_adv,bool * tx_pause,bool * rx_pause)24 void linkmode_resolve_pause(const unsigned long *local_adv,
25 const unsigned long *partner_adv,
26 bool *tx_pause, bool *rx_pause)
27 {
28 __ETHTOOL_DECLARE_LINK_MODE_MASK(m);
29
30 linkmode_and(m, local_adv, partner_adv);
31 if (linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, m)) {
32 *tx_pause = true;
33 *rx_pause = true;
34 } else if (linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, m)) {
35 *tx_pause = linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT,
36 partner_adv);
37 *rx_pause = linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT,
38 local_adv);
39 } else {
40 *tx_pause = false;
41 *rx_pause = false;
42 }
43 }
44 EXPORT_SYMBOL_GPL(linkmode_resolve_pause);
45
46 /**
47 * linkmode_set_pause - set the pause mode advertisement
48 * @advertisement: advertisement in ethtool format
49 * @tx: boolean from ethtool struct ethtool_pauseparam tx_pause member
50 * @rx: boolean from ethtool struct ethtool_pauseparam rx_pause member
51 *
52 * Configure the advertised Pause and Asym_Pause bits according to the
53 * capabilities of provided in @tx and @rx.
54 *
55 * We convert as follows:
56 * tx rx Pause AsymDir
57 * 0 0 0 0
58 * 0 1 1 1
59 * 1 0 0 1
60 * 1 1 1 0
61 *
62 * Note: this translation from ethtool tx/rx notation to the advertisement
63 * is actually very problematical. Here are some examples:
64 *
65 * For tx=0 rx=1, meaning transmit is unsupported, receive is supported:
66 *
67 * Local device Link partner
68 * Pause AsymDir Pause AsymDir Result
69 * 1 1 1 0 TX + RX - but we have no TX support.
70 * 1 1 0 1 Only this gives RX only
71 *
72 * For tx=1 rx=1, meaning we have the capability to transmit and receive
73 * pause frames:
74 *
75 * Local device Link partner
76 * Pause AsymDir Pause AsymDir Result
77 * 1 0 0 1 Disabled - but since we do support tx and rx,
78 * this should resolve to RX only.
79 *
80 * Hence, asking for:
81 * rx=1 tx=0 gives Pause+AsymDir advertisement, but we may end up
82 * resolving to tx+rx pause or only rx pause depending on
83 * the partners advertisement.
84 * rx=0 tx=1 gives AsymDir only, which will only give tx pause if
85 * the partners advertisement allows it.
86 * rx=1 tx=1 gives Pause only, which will only allow tx+rx pause
87 * if the other end also advertises Pause.
88 */
linkmode_set_pause(unsigned long * advertisement,bool tx,bool rx)89 void linkmode_set_pause(unsigned long *advertisement, bool tx, bool rx)
90 {
91 linkmode_mod_bit(ETHTOOL_LINK_MODE_Pause_BIT, advertisement, rx);
92 linkmode_mod_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, advertisement,
93 rx ^ tx);
94 }
95 EXPORT_SYMBOL_GPL(linkmode_set_pause);
96