ixgbe_dcb_nl.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782
  1. /*******************************************************************************
  2. Intel 10 Gigabit PCI Express Linux driver
  3. Copyright(c) 1999 - 2012 Intel Corporation.
  4. This program is free software; you can redistribute it and/or modify it
  5. under the terms and conditions of the GNU General Public License,
  6. version 2, as published by the Free Software Foundation.
  7. This program is distributed in the hope it will be useful, but WITHOUT
  8. ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  9. FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  10. more details.
  11. You should have received a copy of the GNU General Public License along with
  12. this program; if not, write to the Free Software Foundation, Inc.,
  13. 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  14. The full GNU General Public License is included in this distribution in
  15. the file called "COPYING".
  16. Contact Information:
  17. Linux NICS <linux.nics@intel.com>
  18. e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
  19. Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  20. *******************************************************************************/
  21. #include "ixgbe.h"
  22. #include <linux/dcbnl.h>
  23. #include "ixgbe_dcb_82598.h"
  24. #include "ixgbe_dcb_82599.h"
  25. /* Callbacks for DCB netlink in the kernel */
  26. #define BIT_DCB_MODE 0x01
  27. #define BIT_PFC 0x02
  28. #define BIT_PG_RX 0x04
  29. #define BIT_PG_TX 0x08
  30. #define BIT_APP_UPCHG 0x10
  31. #define BIT_LINKSPEED 0x80
  32. /* Responses for the DCB_C_SET_ALL command */
  33. #define DCB_HW_CHG_RST 0 /* DCB configuration changed with reset */
  34. #define DCB_NO_HW_CHG 1 /* DCB configuration did not change */
  35. #define DCB_HW_CHG 2 /* DCB configuration changed, no reset */
  36. static int ixgbe_copy_dcb_cfg(struct ixgbe_adapter *adapter, int tc_max)
  37. {
  38. struct ixgbe_dcb_config *scfg = &adapter->temp_dcb_cfg;
  39. struct ixgbe_dcb_config *dcfg = &adapter->dcb_cfg;
  40. struct tc_configuration *src = NULL;
  41. struct tc_configuration *dst = NULL;
  42. int i, j;
  43. int tx = DCB_TX_CONFIG;
  44. int rx = DCB_RX_CONFIG;
  45. int changes = 0;
  46. #ifdef IXGBE_FCOE
  47. struct dcb_app app = {
  48. .selector = DCB_APP_IDTYPE_ETHTYPE,
  49. .protocol = ETH_P_FCOE,
  50. };
  51. u8 up = dcb_getapp(adapter->netdev, &app);
  52. if (up && !(up & (1 << adapter->fcoe.up)))
  53. changes |= BIT_APP_UPCHG;
  54. #endif
  55. for (i = DCB_PG_ATTR_TC_0; i < tc_max + DCB_PG_ATTR_TC_0; i++) {
  56. src = &scfg->tc_config[i - DCB_PG_ATTR_TC_0];
  57. dst = &dcfg->tc_config[i - DCB_PG_ATTR_TC_0];
  58. if (dst->path[tx].prio_type != src->path[tx].prio_type) {
  59. dst->path[tx].prio_type = src->path[tx].prio_type;
  60. changes |= BIT_PG_TX;
  61. }
  62. if (dst->path[tx].bwg_id != src->path[tx].bwg_id) {
  63. dst->path[tx].bwg_id = src->path[tx].bwg_id;
  64. changes |= BIT_PG_TX;
  65. }
  66. if (dst->path[tx].bwg_percent != src->path[tx].bwg_percent) {
  67. dst->path[tx].bwg_percent = src->path[tx].bwg_percent;
  68. changes |= BIT_PG_TX;
  69. }
  70. if (dst->path[tx].up_to_tc_bitmap !=
  71. src->path[tx].up_to_tc_bitmap) {
  72. dst->path[tx].up_to_tc_bitmap =
  73. src->path[tx].up_to_tc_bitmap;
  74. changes |= (BIT_PG_TX | BIT_PFC | BIT_APP_UPCHG);
  75. }
  76. if (dst->path[rx].prio_type != src->path[rx].prio_type) {
  77. dst->path[rx].prio_type = src->path[rx].prio_type;
  78. changes |= BIT_PG_RX;
  79. }
  80. if (dst->path[rx].bwg_id != src->path[rx].bwg_id) {
  81. dst->path[rx].bwg_id = src->path[rx].bwg_id;
  82. changes |= BIT_PG_RX;
  83. }
  84. if (dst->path[rx].bwg_percent != src->path[rx].bwg_percent) {
  85. dst->path[rx].bwg_percent = src->path[rx].bwg_percent;
  86. changes |= BIT_PG_RX;
  87. }
  88. if (dst->path[rx].up_to_tc_bitmap !=
  89. src->path[rx].up_to_tc_bitmap) {
  90. dst->path[rx].up_to_tc_bitmap =
  91. src->path[rx].up_to_tc_bitmap;
  92. changes |= (BIT_PG_RX | BIT_PFC | BIT_APP_UPCHG);
  93. }
  94. }
  95. for (i = DCB_PG_ATTR_BW_ID_0; i < DCB_PG_ATTR_BW_ID_MAX; i++) {
  96. j = i - DCB_PG_ATTR_BW_ID_0;
  97. if (dcfg->bw_percentage[tx][j] != scfg->bw_percentage[tx][j]) {
  98. dcfg->bw_percentage[tx][j] = scfg->bw_percentage[tx][j];
  99. changes |= BIT_PG_TX;
  100. }
  101. if (dcfg->bw_percentage[rx][j] != scfg->bw_percentage[rx][j]) {
  102. dcfg->bw_percentage[rx][j] = scfg->bw_percentage[rx][j];
  103. changes |= BIT_PG_RX;
  104. }
  105. }
  106. for (i = DCB_PFC_UP_ATTR_0; i < DCB_PFC_UP_ATTR_MAX; i++) {
  107. j = i - DCB_PFC_UP_ATTR_0;
  108. if (dcfg->tc_config[j].dcb_pfc != scfg->tc_config[j].dcb_pfc) {
  109. dcfg->tc_config[j].dcb_pfc = scfg->tc_config[j].dcb_pfc;
  110. changes |= BIT_PFC;
  111. }
  112. }
  113. if (dcfg->pfc_mode_enable != scfg->pfc_mode_enable) {
  114. dcfg->pfc_mode_enable = scfg->pfc_mode_enable;
  115. changes |= BIT_PFC;
  116. }
  117. return changes;
  118. }
  119. static u8 ixgbe_dcbnl_get_state(struct net_device *netdev)
  120. {
  121. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  122. return !!(adapter->flags & IXGBE_FLAG_DCB_ENABLED);
  123. }
  124. static u8 ixgbe_dcbnl_set_state(struct net_device *netdev, u8 state)
  125. {
  126. int err = 0;
  127. u8 prio_tc[MAX_USER_PRIORITY] = {0};
  128. int i;
  129. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  130. /* Fail command if not in CEE mode */
  131. if (!(adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE))
  132. return 1;
  133. /* verify there is something to do, if not then exit */
  134. if (!!state != !(adapter->flags & IXGBE_FLAG_DCB_ENABLED))
  135. goto out;
  136. if (state > 0) {
  137. err = ixgbe_setup_tc(netdev, adapter->dcb_cfg.num_tcs.pg_tcs);
  138. ixgbe_dcb_unpack_map(&adapter->dcb_cfg, DCB_TX_CONFIG, prio_tc);
  139. } else {
  140. err = ixgbe_setup_tc(netdev, 0);
  141. }
  142. if (err)
  143. goto out;
  144. for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
  145. netdev_set_prio_tc_map(netdev, i, prio_tc[i]);
  146. out:
  147. return err ? 1 : 0;
  148. }
  149. static void ixgbe_dcbnl_get_perm_hw_addr(struct net_device *netdev,
  150. u8 *perm_addr)
  151. {
  152. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  153. int i, j;
  154. memset(perm_addr, 0xff, MAX_ADDR_LEN);
  155. for (i = 0; i < netdev->addr_len; i++)
  156. perm_addr[i] = adapter->hw.mac.perm_addr[i];
  157. switch (adapter->hw.mac.type) {
  158. case ixgbe_mac_82599EB:
  159. case ixgbe_mac_X540:
  160. for (j = 0; j < netdev->addr_len; j++, i++)
  161. perm_addr[i] = adapter->hw.mac.san_addr[j];
  162. break;
  163. default:
  164. break;
  165. }
  166. }
  167. static void ixgbe_dcbnl_set_pg_tc_cfg_tx(struct net_device *netdev, int tc,
  168. u8 prio, u8 bwg_id, u8 bw_pct,
  169. u8 up_map)
  170. {
  171. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  172. if (prio != DCB_ATTR_VALUE_UNDEFINED)
  173. adapter->temp_dcb_cfg.tc_config[tc].path[0].prio_type = prio;
  174. if (bwg_id != DCB_ATTR_VALUE_UNDEFINED)
  175. adapter->temp_dcb_cfg.tc_config[tc].path[0].bwg_id = bwg_id;
  176. if (bw_pct != DCB_ATTR_VALUE_UNDEFINED)
  177. adapter->temp_dcb_cfg.tc_config[tc].path[0].bwg_percent =
  178. bw_pct;
  179. if (up_map != DCB_ATTR_VALUE_UNDEFINED)
  180. adapter->temp_dcb_cfg.tc_config[tc].path[0].up_to_tc_bitmap =
  181. up_map;
  182. }
  183. static void ixgbe_dcbnl_set_pg_bwg_cfg_tx(struct net_device *netdev, int bwg_id,
  184. u8 bw_pct)
  185. {
  186. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  187. adapter->temp_dcb_cfg.bw_percentage[0][bwg_id] = bw_pct;
  188. }
  189. static void ixgbe_dcbnl_set_pg_tc_cfg_rx(struct net_device *netdev, int tc,
  190. u8 prio, u8 bwg_id, u8 bw_pct,
  191. u8 up_map)
  192. {
  193. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  194. if (prio != DCB_ATTR_VALUE_UNDEFINED)
  195. adapter->temp_dcb_cfg.tc_config[tc].path[1].prio_type = prio;
  196. if (bwg_id != DCB_ATTR_VALUE_UNDEFINED)
  197. adapter->temp_dcb_cfg.tc_config[tc].path[1].bwg_id = bwg_id;
  198. if (bw_pct != DCB_ATTR_VALUE_UNDEFINED)
  199. adapter->temp_dcb_cfg.tc_config[tc].path[1].bwg_percent =
  200. bw_pct;
  201. if (up_map != DCB_ATTR_VALUE_UNDEFINED)
  202. adapter->temp_dcb_cfg.tc_config[tc].path[1].up_to_tc_bitmap =
  203. up_map;
  204. }
  205. static void ixgbe_dcbnl_set_pg_bwg_cfg_rx(struct net_device *netdev, int bwg_id,
  206. u8 bw_pct)
  207. {
  208. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  209. adapter->temp_dcb_cfg.bw_percentage[1][bwg_id] = bw_pct;
  210. }
  211. static void ixgbe_dcbnl_get_pg_tc_cfg_tx(struct net_device *netdev, int tc,
  212. u8 *prio, u8 *bwg_id, u8 *bw_pct,
  213. u8 *up_map)
  214. {
  215. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  216. *prio = adapter->dcb_cfg.tc_config[tc].path[0].prio_type;
  217. *bwg_id = adapter->dcb_cfg.tc_config[tc].path[0].bwg_id;
  218. *bw_pct = adapter->dcb_cfg.tc_config[tc].path[0].bwg_percent;
  219. *up_map = adapter->dcb_cfg.tc_config[tc].path[0].up_to_tc_bitmap;
  220. }
  221. static void ixgbe_dcbnl_get_pg_bwg_cfg_tx(struct net_device *netdev, int bwg_id,
  222. u8 *bw_pct)
  223. {
  224. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  225. *bw_pct = adapter->dcb_cfg.bw_percentage[0][bwg_id];
  226. }
  227. static void ixgbe_dcbnl_get_pg_tc_cfg_rx(struct net_device *netdev, int tc,
  228. u8 *prio, u8 *bwg_id, u8 *bw_pct,
  229. u8 *up_map)
  230. {
  231. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  232. *prio = adapter->dcb_cfg.tc_config[tc].path[1].prio_type;
  233. *bwg_id = adapter->dcb_cfg.tc_config[tc].path[1].bwg_id;
  234. *bw_pct = adapter->dcb_cfg.tc_config[tc].path[1].bwg_percent;
  235. *up_map = adapter->dcb_cfg.tc_config[tc].path[1].up_to_tc_bitmap;
  236. }
  237. static void ixgbe_dcbnl_get_pg_bwg_cfg_rx(struct net_device *netdev, int bwg_id,
  238. u8 *bw_pct)
  239. {
  240. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  241. *bw_pct = adapter->dcb_cfg.bw_percentage[1][bwg_id];
  242. }
  243. static void ixgbe_dcbnl_set_pfc_cfg(struct net_device *netdev, int priority,
  244. u8 setting)
  245. {
  246. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  247. adapter->temp_dcb_cfg.tc_config[priority].dcb_pfc = setting;
  248. if (adapter->temp_dcb_cfg.tc_config[priority].dcb_pfc !=
  249. adapter->dcb_cfg.tc_config[priority].dcb_pfc)
  250. adapter->temp_dcb_cfg.pfc_mode_enable = true;
  251. }
  252. static void ixgbe_dcbnl_get_pfc_cfg(struct net_device *netdev, int priority,
  253. u8 *setting)
  254. {
  255. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  256. *setting = adapter->dcb_cfg.tc_config[priority].dcb_pfc;
  257. }
  258. #ifdef IXGBE_FCOE
  259. static void ixgbe_dcbnl_devreset(struct net_device *dev)
  260. {
  261. struct ixgbe_adapter *adapter = netdev_priv(dev);
  262. while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
  263. usleep_range(1000, 2000);
  264. if (netif_running(dev))
  265. dev->netdev_ops->ndo_stop(dev);
  266. ixgbe_clear_interrupt_scheme(adapter);
  267. ixgbe_init_interrupt_scheme(adapter);
  268. if (netif_running(dev))
  269. dev->netdev_ops->ndo_open(dev);
  270. clear_bit(__IXGBE_RESETTING, &adapter->state);
  271. }
  272. #endif
  273. static u8 ixgbe_dcbnl_set_all(struct net_device *netdev)
  274. {
  275. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  276. struct ixgbe_dcb_config *dcb_cfg = &adapter->dcb_cfg;
  277. struct ixgbe_hw *hw = &adapter->hw;
  278. int ret = DCB_NO_HW_CHG;
  279. int i;
  280. /* Fail command if not in CEE mode */
  281. if (!(adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE))
  282. return ret;
  283. adapter->dcb_set_bitmap |= ixgbe_copy_dcb_cfg(adapter,
  284. MAX_TRAFFIC_CLASS);
  285. if (!adapter->dcb_set_bitmap)
  286. return ret;
  287. if (adapter->dcb_set_bitmap & (BIT_PG_TX|BIT_PG_RX)) {
  288. u16 refill[MAX_TRAFFIC_CLASS], max[MAX_TRAFFIC_CLASS];
  289. u8 bwg_id[MAX_TRAFFIC_CLASS], prio_type[MAX_TRAFFIC_CLASS];
  290. /* Priority to TC mapping in CEE case default to 1:1 */
  291. u8 prio_tc[MAX_USER_PRIORITY];
  292. int max_frame = adapter->netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
  293. #ifdef IXGBE_FCOE
  294. if (adapter->netdev->features & NETIF_F_FCOE_MTU)
  295. max_frame = max(max_frame, IXGBE_FCOE_JUMBO_FRAME_SIZE);
  296. #endif
  297. ixgbe_dcb_calculate_tc_credits(hw, dcb_cfg, max_frame,
  298. DCB_TX_CONFIG);
  299. ixgbe_dcb_calculate_tc_credits(hw, dcb_cfg, max_frame,
  300. DCB_RX_CONFIG);
  301. ixgbe_dcb_unpack_refill(dcb_cfg, DCB_TX_CONFIG, refill);
  302. ixgbe_dcb_unpack_max(dcb_cfg, max);
  303. ixgbe_dcb_unpack_bwgid(dcb_cfg, DCB_TX_CONFIG, bwg_id);
  304. ixgbe_dcb_unpack_prio(dcb_cfg, DCB_TX_CONFIG, prio_type);
  305. ixgbe_dcb_unpack_map(dcb_cfg, DCB_TX_CONFIG, prio_tc);
  306. ixgbe_dcb_hw_ets_config(hw, refill, max, bwg_id,
  307. prio_type, prio_tc);
  308. for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
  309. netdev_set_prio_tc_map(netdev, i, prio_tc[i]);
  310. ret = DCB_HW_CHG_RST;
  311. }
  312. if (adapter->dcb_set_bitmap & BIT_PFC) {
  313. if (dcb_cfg->pfc_mode_enable) {
  314. u8 pfc_en;
  315. u8 prio_tc[MAX_USER_PRIORITY];
  316. ixgbe_dcb_unpack_map(dcb_cfg, DCB_TX_CONFIG, prio_tc);
  317. ixgbe_dcb_unpack_pfc(dcb_cfg, &pfc_en);
  318. ixgbe_dcb_hw_pfc_config(hw, pfc_en, prio_tc);
  319. } else {
  320. hw->mac.ops.fc_enable(hw);
  321. }
  322. ixgbe_set_rx_drop_en(adapter);
  323. ret = DCB_HW_CHG;
  324. }
  325. #ifdef IXGBE_FCOE
  326. /* Reprogam FCoE hardware offloads when the traffic class
  327. * FCoE is using changes. This happens if the APP info
  328. * changes or the up2tc mapping is updated.
  329. */
  330. if (adapter->dcb_set_bitmap & BIT_APP_UPCHG) {
  331. struct dcb_app app = {
  332. .selector = DCB_APP_IDTYPE_ETHTYPE,
  333. .protocol = ETH_P_FCOE,
  334. };
  335. u8 up = dcb_getapp(netdev, &app);
  336. adapter->fcoe.up = ffs(up) - 1;
  337. ixgbe_dcbnl_devreset(netdev);
  338. ret = DCB_HW_CHG_RST;
  339. }
  340. #endif
  341. adapter->dcb_set_bitmap = 0x00;
  342. return ret;
  343. }
  344. static u8 ixgbe_dcbnl_getcap(struct net_device *netdev, int capid, u8 *cap)
  345. {
  346. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  347. switch (capid) {
  348. case DCB_CAP_ATTR_PG:
  349. *cap = true;
  350. break;
  351. case DCB_CAP_ATTR_PFC:
  352. *cap = true;
  353. break;
  354. case DCB_CAP_ATTR_UP2TC:
  355. *cap = false;
  356. break;
  357. case DCB_CAP_ATTR_PG_TCS:
  358. *cap = 0x80;
  359. break;
  360. case DCB_CAP_ATTR_PFC_TCS:
  361. *cap = 0x80;
  362. break;
  363. case DCB_CAP_ATTR_GSP:
  364. *cap = true;
  365. break;
  366. case DCB_CAP_ATTR_BCN:
  367. *cap = false;
  368. break;
  369. case DCB_CAP_ATTR_DCBX:
  370. *cap = adapter->dcbx_cap;
  371. break;
  372. default:
  373. *cap = false;
  374. break;
  375. }
  376. return 0;
  377. }
  378. static int ixgbe_dcbnl_getnumtcs(struct net_device *netdev, int tcid, u8 *num)
  379. {
  380. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  381. u8 rval = 0;
  382. if (adapter->flags & IXGBE_FLAG_DCB_ENABLED) {
  383. switch (tcid) {
  384. case DCB_NUMTCS_ATTR_PG:
  385. *num = adapter->dcb_cfg.num_tcs.pg_tcs;
  386. break;
  387. case DCB_NUMTCS_ATTR_PFC:
  388. *num = adapter->dcb_cfg.num_tcs.pfc_tcs;
  389. break;
  390. default:
  391. rval = -EINVAL;
  392. break;
  393. }
  394. } else {
  395. rval = -EINVAL;
  396. }
  397. return rval;
  398. }
  399. static int ixgbe_dcbnl_setnumtcs(struct net_device *netdev, int tcid, u8 num)
  400. {
  401. return -EINVAL;
  402. }
  403. static u8 ixgbe_dcbnl_getpfcstate(struct net_device *netdev)
  404. {
  405. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  406. return adapter->dcb_cfg.pfc_mode_enable;
  407. }
  408. static void ixgbe_dcbnl_setpfcstate(struct net_device *netdev, u8 state)
  409. {
  410. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  411. adapter->temp_dcb_cfg.pfc_mode_enable = state;
  412. }
  413. /**
  414. * ixgbe_dcbnl_getapp - retrieve the DCBX application user priority
  415. * @netdev : the corresponding netdev
  416. * @idtype : identifies the id as ether type or TCP/UDP port number
  417. * @id: id is either ether type or TCP/UDP port number
  418. *
  419. * Returns : on success, returns a non-zero 802.1p user priority bitmap
  420. * otherwise returns 0 as the invalid user priority bitmap to indicate an
  421. * error.
  422. */
  423. static u8 ixgbe_dcbnl_getapp(struct net_device *netdev, u8 idtype, u16 id)
  424. {
  425. struct ixgbe_adapter *adapter = netdev_priv(netdev);
  426. struct dcb_app app = {
  427. .selector = idtype,
  428. .protocol = id,
  429. };
  430. if (!(adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE))
  431. return 0;
  432. return dcb_getapp(netdev, &app);
  433. }
  434. static int ixgbe_dcbnl_ieee_getets(struct net_device *dev,
  435. struct ieee_ets *ets)
  436. {
  437. struct ixgbe_adapter *adapter = netdev_priv(dev);
  438. struct ieee_ets *my_ets = adapter->ixgbe_ieee_ets;
  439. ets->ets_cap = adapter->dcb_cfg.num_tcs.pg_tcs;
  440. /* No IEEE PFC settings available */
  441. if (!my_ets)
  442. return 0;
  443. ets->cbs = my_ets->cbs;
  444. memcpy(ets->tc_tx_bw, my_ets->tc_tx_bw, sizeof(ets->tc_tx_bw));
  445. memcpy(ets->tc_rx_bw, my_ets->tc_rx_bw, sizeof(ets->tc_rx_bw));
  446. memcpy(ets->tc_tsa, my_ets->tc_tsa, sizeof(ets->tc_tsa));
  447. memcpy(ets->prio_tc, my_ets->prio_tc, sizeof(ets->prio_tc));
  448. return 0;
  449. }
  450. static int ixgbe_dcbnl_ieee_setets(struct net_device *dev,
  451. struct ieee_ets *ets)
  452. {
  453. struct ixgbe_adapter *adapter = netdev_priv(dev);
  454. int max_frame = dev->mtu + ETH_HLEN + ETH_FCS_LEN;
  455. int i, err = 0;
  456. __u8 max_tc = 0;
  457. if (!(adapter->dcbx_cap & DCB_CAP_DCBX_VER_IEEE))
  458. return -EINVAL;
  459. if (!adapter->ixgbe_ieee_ets) {
  460. adapter->ixgbe_ieee_ets = kmalloc(sizeof(struct ieee_ets),
  461. GFP_KERNEL);
  462. if (!adapter->ixgbe_ieee_ets)
  463. return -ENOMEM;
  464. }
  465. memcpy(adapter->ixgbe_ieee_ets, ets, sizeof(*adapter->ixgbe_ieee_ets));
  466. for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) {
  467. if (ets->prio_tc[i] > max_tc)
  468. max_tc = ets->prio_tc[i];
  469. }
  470. if (max_tc)
  471. max_tc++;
  472. if (max_tc > adapter->dcb_cfg.num_tcs.pg_tcs)
  473. return -EINVAL;
  474. if (max_tc != netdev_get_num_tc(dev))
  475. err = ixgbe_setup_tc(dev, max_tc);
  476. if (err)
  477. goto err_out;
  478. for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
  479. netdev_set_prio_tc_map(dev, i, ets->prio_tc[i]);
  480. err = ixgbe_dcb_hw_ets(&adapter->hw, ets, max_frame);
  481. err_out:
  482. return err;
  483. }
  484. static int ixgbe_dcbnl_ieee_getpfc(struct net_device *dev,
  485. struct ieee_pfc *pfc)
  486. {
  487. struct ixgbe_adapter *adapter = netdev_priv(dev);
  488. struct ieee_pfc *my_pfc = adapter->ixgbe_ieee_pfc;
  489. int i;
  490. pfc->pfc_cap = adapter->dcb_cfg.num_tcs.pfc_tcs;
  491. /* No IEEE PFC settings available */
  492. if (!my_pfc)
  493. return 0;
  494. pfc->pfc_en = my_pfc->pfc_en;
  495. pfc->mbc = my_pfc->mbc;
  496. pfc->delay = my_pfc->delay;
  497. for (i = 0; i < MAX_TRAFFIC_CLASS; i++) {
  498. pfc->requests[i] = adapter->stats.pxoffrxc[i];
  499. pfc->indications[i] = adapter->stats.pxofftxc[i];
  500. }
  501. return 0;
  502. }
  503. static int ixgbe_dcbnl_ieee_setpfc(struct net_device *dev,
  504. struct ieee_pfc *pfc)
  505. {
  506. struct ixgbe_adapter *adapter = netdev_priv(dev);
  507. struct ixgbe_hw *hw = &adapter->hw;
  508. u8 *prio_tc;
  509. int err;
  510. if (!(adapter->dcbx_cap & DCB_CAP_DCBX_VER_IEEE))
  511. return -EINVAL;
  512. if (!adapter->ixgbe_ieee_pfc) {
  513. adapter->ixgbe_ieee_pfc = kmalloc(sizeof(struct ieee_pfc),
  514. GFP_KERNEL);
  515. if (!adapter->ixgbe_ieee_pfc)
  516. return -ENOMEM;
  517. }
  518. prio_tc = adapter->ixgbe_ieee_ets->prio_tc;
  519. memcpy(adapter->ixgbe_ieee_pfc, pfc, sizeof(*adapter->ixgbe_ieee_pfc));
  520. /* Enable link flow control parameters if PFC is disabled */
  521. if (pfc->pfc_en)
  522. err = ixgbe_dcb_hw_pfc_config(hw, pfc->pfc_en, prio_tc);
  523. else
  524. err = hw->mac.ops.fc_enable(hw);
  525. ixgbe_set_rx_drop_en(adapter);
  526. return err;
  527. }
  528. static int ixgbe_dcbnl_ieee_setapp(struct net_device *dev,
  529. struct dcb_app *app)
  530. {
  531. struct ixgbe_adapter *adapter = netdev_priv(dev);
  532. int err = -EINVAL;
  533. if (!(adapter->dcbx_cap & DCB_CAP_DCBX_VER_IEEE))
  534. return err;
  535. err = dcb_ieee_setapp(dev, app);
  536. #ifdef IXGBE_FCOE
  537. if (!err && app->selector == IEEE_8021QAZ_APP_SEL_ETHERTYPE &&
  538. app->protocol == ETH_P_FCOE) {
  539. u8 app_mask = dcb_ieee_getapp_mask(dev, app);
  540. if (app_mask & (1 << adapter->fcoe.up))
  541. return err;
  542. adapter->fcoe.up = app->priority;
  543. ixgbe_dcbnl_devreset(dev);
  544. }
  545. #endif
  546. return 0;
  547. }
  548. static int ixgbe_dcbnl_ieee_delapp(struct net_device *dev,
  549. struct dcb_app *app)
  550. {
  551. struct ixgbe_adapter *adapter = netdev_priv(dev);
  552. int err;
  553. if (!(adapter->dcbx_cap & DCB_CAP_DCBX_VER_IEEE))
  554. return -EINVAL;
  555. err = dcb_ieee_delapp(dev, app);
  556. #ifdef IXGBE_FCOE
  557. if (!err && app->selector == IEEE_8021QAZ_APP_SEL_ETHERTYPE &&
  558. app->protocol == ETH_P_FCOE) {
  559. u8 app_mask = dcb_ieee_getapp_mask(dev, app);
  560. if (app_mask & (1 << adapter->fcoe.up))
  561. return err;
  562. adapter->fcoe.up = app_mask ?
  563. ffs(app_mask) - 1 : IXGBE_FCOE_DEFTC;
  564. ixgbe_dcbnl_devreset(dev);
  565. }
  566. #endif
  567. return err;
  568. }
  569. static u8 ixgbe_dcbnl_getdcbx(struct net_device *dev)
  570. {
  571. struct ixgbe_adapter *adapter = netdev_priv(dev);
  572. return adapter->dcbx_cap;
  573. }
  574. static u8 ixgbe_dcbnl_setdcbx(struct net_device *dev, u8 mode)
  575. {
  576. struct ixgbe_adapter *adapter = netdev_priv(dev);
  577. struct ieee_ets ets = {0};
  578. struct ieee_pfc pfc = {0};
  579. int err = 0;
  580. /* no support for LLD_MANAGED modes or CEE+IEEE */
  581. if ((mode & DCB_CAP_DCBX_LLD_MANAGED) ||
  582. ((mode & DCB_CAP_DCBX_VER_IEEE) && (mode & DCB_CAP_DCBX_VER_CEE)) ||
  583. !(mode & DCB_CAP_DCBX_HOST))
  584. return 1;
  585. if (mode == adapter->dcbx_cap)
  586. return 0;
  587. adapter->dcbx_cap = mode;
  588. /* ETS and PFC defaults */
  589. ets.ets_cap = 8;
  590. pfc.pfc_cap = 8;
  591. if (mode & DCB_CAP_DCBX_VER_IEEE) {
  592. ixgbe_dcbnl_ieee_setets(dev, &ets);
  593. ixgbe_dcbnl_ieee_setpfc(dev, &pfc);
  594. } else if (mode & DCB_CAP_DCBX_VER_CEE) {
  595. u8 mask = BIT_PFC | BIT_PG_TX | BIT_PG_RX | BIT_APP_UPCHG;
  596. adapter->dcb_set_bitmap |= mask;
  597. ixgbe_dcbnl_set_all(dev);
  598. } else {
  599. /* Drop into single TC mode strict priority as this
  600. * indicates CEE and IEEE versions are disabled
  601. */
  602. ixgbe_dcbnl_ieee_setets(dev, &ets);
  603. ixgbe_dcbnl_ieee_setpfc(dev, &pfc);
  604. err = ixgbe_setup_tc(dev, 0);
  605. }
  606. return err ? 1 : 0;
  607. }
  608. const struct dcbnl_rtnl_ops dcbnl_ops = {
  609. .ieee_getets = ixgbe_dcbnl_ieee_getets,
  610. .ieee_setets = ixgbe_dcbnl_ieee_setets,
  611. .ieee_getpfc = ixgbe_dcbnl_ieee_getpfc,
  612. .ieee_setpfc = ixgbe_dcbnl_ieee_setpfc,
  613. .ieee_setapp = ixgbe_dcbnl_ieee_setapp,
  614. .ieee_delapp = ixgbe_dcbnl_ieee_delapp,
  615. .getstate = ixgbe_dcbnl_get_state,
  616. .setstate = ixgbe_dcbnl_set_state,
  617. .getpermhwaddr = ixgbe_dcbnl_get_perm_hw_addr,
  618. .setpgtccfgtx = ixgbe_dcbnl_set_pg_tc_cfg_tx,
  619. .setpgbwgcfgtx = ixgbe_dcbnl_set_pg_bwg_cfg_tx,
  620. .setpgtccfgrx = ixgbe_dcbnl_set_pg_tc_cfg_rx,
  621. .setpgbwgcfgrx = ixgbe_dcbnl_set_pg_bwg_cfg_rx,
  622. .getpgtccfgtx = ixgbe_dcbnl_get_pg_tc_cfg_tx,
  623. .getpgbwgcfgtx = ixgbe_dcbnl_get_pg_bwg_cfg_tx,
  624. .getpgtccfgrx = ixgbe_dcbnl_get_pg_tc_cfg_rx,
  625. .getpgbwgcfgrx = ixgbe_dcbnl_get_pg_bwg_cfg_rx,
  626. .setpfccfg = ixgbe_dcbnl_set_pfc_cfg,
  627. .getpfccfg = ixgbe_dcbnl_get_pfc_cfg,
  628. .setall = ixgbe_dcbnl_set_all,
  629. .getcap = ixgbe_dcbnl_getcap,
  630. .getnumtcs = ixgbe_dcbnl_getnumtcs,
  631. .setnumtcs = ixgbe_dcbnl_setnumtcs,
  632. .getpfcstate = ixgbe_dcbnl_getpfcstate,
  633. .setpfcstate = ixgbe_dcbnl_setpfcstate,
  634. .getapp = ixgbe_dcbnl_getapp,
  635. .getdcbx = ixgbe_dcbnl_getdcbx,
  636. .setdcbx = ixgbe_dcbnl_setdcbx,
  637. };