1 // SPDX-License-Identifier: GPL-2.0+
2 // Copyright (c) 2016-2017 Hisilicon Limited.
3 
4 #include "hclge_main.h"
5 #include "hclge_dcb.h"
6 #include "hclge_tm.h"
7 #include "hnae3.h"
8 
9 #define BW_PERCENT	100
10 
hclge_ieee_ets_to_tm_info(struct hclge_dev * hdev,struct ieee_ets * ets)11 static int hclge_ieee_ets_to_tm_info(struct hclge_dev *hdev,
12 				     struct ieee_ets *ets)
13 {
14 	u8 i;
15 
16 	for (i = 0; i < HNAE3_MAX_TC; i++) {
17 		switch (ets->tc_tsa[i]) {
18 		case IEEE_8021QAZ_TSA_STRICT:
19 			hdev->tm_info.tc_info[i].tc_sch_mode =
20 				HCLGE_SCH_MODE_SP;
21 			hdev->tm_info.pg_info[0].tc_dwrr[i] = 0;
22 			break;
23 		case IEEE_8021QAZ_TSA_ETS:
24 			hdev->tm_info.tc_info[i].tc_sch_mode =
25 				HCLGE_SCH_MODE_DWRR;
26 			hdev->tm_info.pg_info[0].tc_dwrr[i] =
27 				ets->tc_tx_bw[i];
28 			break;
29 		default:
30 			/* Hardware only supports SP (strict priority)
31 			 * or ETS (enhanced transmission selection)
32 			 * algorithms, if we receive some other value
33 			 * from dcbnl, then throw an error.
34 			 */
35 			return -EINVAL;
36 		}
37 	}
38 
39 	hclge_tm_prio_tc_info_update(hdev, ets->prio_tc);
40 
41 	return 0;
42 }
43 
hclge_tm_info_to_ieee_ets(struct hclge_dev * hdev,struct ieee_ets * ets)44 static void hclge_tm_info_to_ieee_ets(struct hclge_dev *hdev,
45 				      struct ieee_ets *ets)
46 {
47 	u32 i;
48 
49 	memset(ets, 0, sizeof(*ets));
50 	ets->willing = 1;
51 	ets->ets_cap = hdev->tc_max;
52 
53 	for (i = 0; i < HNAE3_MAX_TC; i++) {
54 		ets->prio_tc[i] = hdev->tm_info.prio_tc[i];
55 		if (i < hdev->tm_info.num_tc)
56 			ets->tc_tx_bw[i] = hdev->tm_info.pg_info[0].tc_dwrr[i];
57 		else
58 			ets->tc_tx_bw[i] = 0;
59 
60 		if (hdev->tm_info.tc_info[i].tc_sch_mode ==
61 		    HCLGE_SCH_MODE_SP)
62 			ets->tc_tsa[i] = IEEE_8021QAZ_TSA_STRICT;
63 		else
64 			ets->tc_tsa[i] = IEEE_8021QAZ_TSA_ETS;
65 	}
66 }
67 
68 /* IEEE std */
hclge_ieee_getets(struct hnae3_handle * h,struct ieee_ets * ets)69 static int hclge_ieee_getets(struct hnae3_handle *h, struct ieee_ets *ets)
70 {
71 	struct hclge_vport *vport = hclge_get_vport(h);
72 	struct hclge_dev *hdev = vport->back;
73 
74 	hclge_tm_info_to_ieee_ets(hdev, ets);
75 
76 	return 0;
77 }
78 
hclge_dcb_common_validate(struct hclge_dev * hdev,u8 num_tc,u8 * prio_tc)79 static int hclge_dcb_common_validate(struct hclge_dev *hdev, u8 num_tc,
80 				     u8 *prio_tc)
81 {
82 	int i;
83 
84 	if (num_tc > hdev->tc_max) {
85 		dev_err(&hdev->pdev->dev,
86 			"tc num checking failed, %u > tc_max(%u)\n",
87 			num_tc, hdev->tc_max);
88 		return -EINVAL;
89 	}
90 
91 	for (i = 0; i < HNAE3_MAX_USER_PRIO; i++) {
92 		if (prio_tc[i] >= num_tc) {
93 			dev_err(&hdev->pdev->dev,
94 				"prio_tc[%d] checking failed, %u >= num_tc(%u)\n",
95 				i, prio_tc[i], num_tc);
96 			return -EINVAL;
97 		}
98 	}
99 
100 	if (num_tc > hdev->vport[0].alloc_tqps) {
101 		dev_err(&hdev->pdev->dev,
102 			"allocated tqp checking failed, %u > tqp(%u)\n",
103 			num_tc, hdev->vport[0].alloc_tqps);
104 		return -EINVAL;
105 	}
106 
107 	return 0;
108 }
109 
hclge_ets_tc_changed(struct hclge_dev * hdev,struct ieee_ets * ets,bool * changed)110 static u8 hclge_ets_tc_changed(struct hclge_dev *hdev, struct ieee_ets *ets,
111 			       bool *changed)
112 {
113 	u8 max_tc_id = 0;
114 	u8 i;
115 
116 	for (i = 0; i < HNAE3_MAX_USER_PRIO; i++) {
117 		if (ets->prio_tc[i] != hdev->tm_info.prio_tc[i])
118 			*changed = true;
119 
120 		if (ets->prio_tc[i] > max_tc_id)
121 			max_tc_id = ets->prio_tc[i];
122 	}
123 
124 	/* return max tc number, max tc id need to plus 1 */
125 	return max_tc_id + 1;
126 }
127 
hclge_ets_sch_mode_validate(struct hclge_dev * hdev,struct ieee_ets * ets,bool * changed,u8 tc_num)128 static int hclge_ets_sch_mode_validate(struct hclge_dev *hdev,
129 				       struct ieee_ets *ets, bool *changed,
130 				       u8 tc_num)
131 {
132 	bool has_ets_tc = false;
133 	u32 total_ets_bw = 0;
134 	u8 i;
135 
136 	for (i = 0; i < HNAE3_MAX_TC; i++) {
137 		switch (ets->tc_tsa[i]) {
138 		case IEEE_8021QAZ_TSA_STRICT:
139 			if (hdev->tm_info.tc_info[i].tc_sch_mode !=
140 				HCLGE_SCH_MODE_SP)
141 				*changed = true;
142 			break;
143 		case IEEE_8021QAZ_TSA_ETS:
144 			if (i >= tc_num) {
145 				dev_err(&hdev->pdev->dev,
146 					"tc%u is disabled, cannot set ets bw\n",
147 					i);
148 				return -EINVAL;
149 			}
150 
151 			/* The hardware will switch to sp mode if bandwidth is
152 			 * 0, so limit ets bandwidth must be greater than 0.
153 			 */
154 			if (!ets->tc_tx_bw[i]) {
155 				dev_err(&hdev->pdev->dev,
156 					"tc%u ets bw cannot be 0\n", i);
157 				return -EINVAL;
158 			}
159 
160 			if (hdev->tm_info.tc_info[i].tc_sch_mode !=
161 				HCLGE_SCH_MODE_DWRR)
162 				*changed = true;
163 
164 			total_ets_bw += ets->tc_tx_bw[i];
165 			has_ets_tc = true;
166 			break;
167 		default:
168 			return -EINVAL;
169 		}
170 	}
171 
172 	if (has_ets_tc && total_ets_bw != BW_PERCENT)
173 		return -EINVAL;
174 
175 	return 0;
176 }
177 
hclge_ets_validate(struct hclge_dev * hdev,struct ieee_ets * ets,u8 * tc,bool * changed)178 static int hclge_ets_validate(struct hclge_dev *hdev, struct ieee_ets *ets,
179 			      u8 *tc, bool *changed)
180 {
181 	u8 tc_num;
182 	int ret;
183 
184 	tc_num = hclge_ets_tc_changed(hdev, ets, changed);
185 
186 	ret = hclge_dcb_common_validate(hdev, tc_num, ets->prio_tc);
187 	if (ret)
188 		return ret;
189 
190 	ret = hclge_ets_sch_mode_validate(hdev, ets, changed, tc_num);
191 	if (ret)
192 		return ret;
193 
194 	*tc = tc_num;
195 	if (*tc != hdev->tm_info.num_tc)
196 		*changed = true;
197 
198 	return 0;
199 }
200 
hclge_map_update(struct hclge_dev * hdev)201 static int hclge_map_update(struct hclge_dev *hdev)
202 {
203 	int ret;
204 
205 	ret = hclge_tm_schd_setup_hw(hdev);
206 	if (ret)
207 		return ret;
208 
209 	ret = hclge_pause_setup_hw(hdev, false);
210 	if (ret)
211 		return ret;
212 
213 	ret = hclge_buffer_alloc(hdev);
214 	if (ret)
215 		return ret;
216 
217 	hclge_comm_rss_indir_init_cfg(hdev->ae_dev, &hdev->rss_cfg);
218 
219 	return hclge_rss_init_hw(hdev);
220 }
221 
hclge_notify_down_uinit(struct hclge_dev * hdev)222 static int hclge_notify_down_uinit(struct hclge_dev *hdev)
223 {
224 	int ret;
225 
226 	ret = hclge_notify_client(hdev, HNAE3_DOWN_CLIENT);
227 	if (ret)
228 		return ret;
229 
230 	ret = hclge_tm_flush_cfg(hdev, true);
231 	if (ret)
232 		return ret;
233 
234 	return hclge_notify_client(hdev, HNAE3_UNINIT_CLIENT);
235 }
236 
hclge_notify_init_up(struct hclge_dev * hdev)237 static int hclge_notify_init_up(struct hclge_dev *hdev)
238 {
239 	int ret;
240 
241 	ret = hclge_notify_client(hdev, HNAE3_INIT_CLIENT);
242 	if (ret)
243 		return ret;
244 
245 	ret = hclge_tm_flush_cfg(hdev, false);
246 	if (ret)
247 		return ret;
248 
249 	return hclge_notify_client(hdev, HNAE3_UP_CLIENT);
250 }
251 
hclge_ieee_setets(struct hnae3_handle * h,struct ieee_ets * ets)252 static int hclge_ieee_setets(struct hnae3_handle *h, struct ieee_ets *ets)
253 {
254 	struct hclge_vport *vport = hclge_get_vport(h);
255 	struct net_device *netdev = h->kinfo.netdev;
256 	struct hclge_dev *hdev = vport->back;
257 	bool map_changed = false;
258 	u8 num_tc = 0;
259 	int ret;
260 
261 	if (!(hdev->dcbx_cap & DCB_CAP_DCBX_VER_IEEE) ||
262 	    h->kinfo.tc_info.mqprio_active)
263 		return -EINVAL;
264 
265 	ret = hclge_ets_validate(hdev, ets, &num_tc, &map_changed);
266 	if (ret)
267 		return ret;
268 
269 	if (map_changed) {
270 		netif_dbg(h, drv, netdev, "set ets\n");
271 
272 		ret = hclge_notify_down_uinit(hdev);
273 		if (ret)
274 			return ret;
275 	}
276 
277 	hclge_tm_schd_info_update(hdev, num_tc);
278 	h->kinfo.tc_info.dcb_ets_active = num_tc > 1;
279 
280 	ret = hclge_ieee_ets_to_tm_info(hdev, ets);
281 	if (ret)
282 		goto err_out;
283 
284 	if (map_changed) {
285 		ret = hclge_map_update(hdev);
286 		if (ret)
287 			goto err_out;
288 
289 		return hclge_notify_init_up(hdev);
290 	}
291 
292 	return hclge_tm_dwrr_cfg(hdev);
293 
294 err_out:
295 	if (!map_changed)
296 		return ret;
297 
298 	hclge_notify_init_up(hdev);
299 
300 	return ret;
301 }
302 
hclge_ieee_getpfc(struct hnae3_handle * h,struct ieee_pfc * pfc)303 static int hclge_ieee_getpfc(struct hnae3_handle *h, struct ieee_pfc *pfc)
304 {
305 	struct hclge_vport *vport = hclge_get_vport(h);
306 	struct hclge_dev *hdev = vport->back;
307 	int ret;
308 
309 	memset(pfc, 0, sizeof(*pfc));
310 	pfc->pfc_cap = hdev->pfc_max;
311 	pfc->pfc_en = hdev->tm_info.pfc_en;
312 
313 	ret = hclge_mac_update_stats(hdev);
314 	if (ret) {
315 		dev_err(&hdev->pdev->dev,
316 			"failed to update MAC stats, ret = %d.\n", ret);
317 		return ret;
318 	}
319 
320 	hclge_pfc_tx_stats_get(hdev, pfc->requests);
321 	hclge_pfc_rx_stats_get(hdev, pfc->indications);
322 
323 	return 0;
324 }
325 
hclge_ieee_setpfc(struct hnae3_handle * h,struct ieee_pfc * pfc)326 static int hclge_ieee_setpfc(struct hnae3_handle *h, struct ieee_pfc *pfc)
327 {
328 	struct hclge_vport *vport = hclge_get_vport(h);
329 	struct net_device *netdev = h->kinfo.netdev;
330 	struct hclge_dev *hdev = vport->back;
331 	u8 i, j, pfc_map, *prio_tc;
332 	int last_bad_ret = 0;
333 	int ret;
334 
335 	if (!(hdev->dcbx_cap & DCB_CAP_DCBX_VER_IEEE))
336 		return -EINVAL;
337 
338 	if (pfc->pfc_en == hdev->tm_info.pfc_en)
339 		return 0;
340 
341 	prio_tc = hdev->tm_info.prio_tc;
342 	pfc_map = 0;
343 
344 	for (i = 0; i < hdev->tm_info.num_tc; i++) {
345 		for (j = 0; j < HNAE3_MAX_USER_PRIO; j++) {
346 			if ((prio_tc[j] == i) && (pfc->pfc_en & BIT(j))) {
347 				pfc_map |= BIT(i);
348 				break;
349 			}
350 		}
351 	}
352 
353 	hdev->tm_info.hw_pfc_map = pfc_map;
354 	hdev->tm_info.pfc_en = pfc->pfc_en;
355 
356 	netif_dbg(h, drv, netdev,
357 		  "set pfc: pfc_en=%x, pfc_map=%x, num_tc=%u\n",
358 		  pfc->pfc_en, pfc_map, hdev->tm_info.num_tc);
359 
360 	hclge_tm_pfc_info_update(hdev);
361 
362 	ret = hclge_pause_setup_hw(hdev, false);
363 	if (ret)
364 		return ret;
365 
366 	ret = hclge_notify_client(hdev, HNAE3_DOWN_CLIENT);
367 	if (ret)
368 		return ret;
369 
370 	ret = hclge_tm_flush_cfg(hdev, true);
371 	if (ret)
372 		return ret;
373 
374 	/* No matter whether the following operations are performed
375 	 * successfully or not, disabling the tm flush and notify
376 	 * the network status to up are necessary.
377 	 * Do not return immediately.
378 	 */
379 	ret = hclge_buffer_alloc(hdev);
380 	if (ret)
381 		last_bad_ret = ret;
382 
383 	ret = hclge_tm_flush_cfg(hdev, false);
384 	if (ret)
385 		last_bad_ret = ret;
386 
387 	ret = hclge_notify_client(hdev, HNAE3_UP_CLIENT);
388 	if (ret)
389 		last_bad_ret = ret;
390 
391 	return last_bad_ret;
392 }
393 
hclge_ieee_setapp(struct hnae3_handle * h,struct dcb_app * app)394 static int hclge_ieee_setapp(struct hnae3_handle *h, struct dcb_app *app)
395 {
396 	struct hclge_vport *vport = hclge_get_vport(h);
397 	struct net_device *netdev = h->kinfo.netdev;
398 	struct hclge_dev *hdev = vport->back;
399 	struct dcb_app old_app;
400 	int ret;
401 
402 	if (app->selector != IEEE_8021QAZ_APP_SEL_DSCP ||
403 	    app->protocol >= HNAE3_MAX_DSCP ||
404 	    app->priority >= HNAE3_MAX_USER_PRIO)
405 		return -EINVAL;
406 
407 	dev_info(&hdev->pdev->dev, "setapp dscp=%u priority=%u\n",
408 		 app->protocol, app->priority);
409 
410 	if (app->priority == h->kinfo.dscp_prio[app->protocol])
411 		return 0;
412 
413 	ret = dcb_ieee_setapp(netdev, app);
414 	if (ret)
415 		return ret;
416 
417 	old_app.selector = IEEE_8021QAZ_APP_SEL_DSCP;
418 	old_app.protocol = app->protocol;
419 	old_app.priority = h->kinfo.dscp_prio[app->protocol];
420 
421 	h->kinfo.dscp_prio[app->protocol] = app->priority;
422 	ret = hclge_dscp_to_tc_map(hdev);
423 	if (ret) {
424 		dev_err(&hdev->pdev->dev,
425 			"failed to set dscp to tc map, ret = %d\n", ret);
426 		h->kinfo.dscp_prio[app->protocol] = old_app.priority;
427 		(void)dcb_ieee_delapp(netdev, app);
428 		return ret;
429 	}
430 
431 	vport->nic.kinfo.tc_map_mode = HNAE3_TC_MAP_MODE_DSCP;
432 	if (old_app.priority == HNAE3_PRIO_ID_INVALID)
433 		h->kinfo.dscp_app_cnt++;
434 	else
435 		ret = dcb_ieee_delapp(netdev, &old_app);
436 
437 	return ret;
438 }
439 
hclge_ieee_delapp(struct hnae3_handle * h,struct dcb_app * app)440 static int hclge_ieee_delapp(struct hnae3_handle *h, struct dcb_app *app)
441 {
442 	struct hclge_vport *vport = hclge_get_vport(h);
443 	struct net_device *netdev = h->kinfo.netdev;
444 	struct hclge_dev *hdev = vport->back;
445 	int ret;
446 
447 	if (app->selector != IEEE_8021QAZ_APP_SEL_DSCP ||
448 	    app->protocol >= HNAE3_MAX_DSCP ||
449 	    app->priority >= HNAE3_MAX_USER_PRIO ||
450 	    app->priority != h->kinfo.dscp_prio[app->protocol])
451 		return -EINVAL;
452 
453 	dev_info(&hdev->pdev->dev, "delapp dscp=%u priority=%u\n",
454 		 app->protocol, app->priority);
455 
456 	ret = dcb_ieee_delapp(netdev, app);
457 	if (ret)
458 		return ret;
459 
460 	h->kinfo.dscp_prio[app->protocol] = HNAE3_PRIO_ID_INVALID;
461 	ret = hclge_dscp_to_tc_map(hdev);
462 	if (ret) {
463 		dev_err(&hdev->pdev->dev,
464 			"failed to del dscp to tc map, ret = %d\n", ret);
465 		h->kinfo.dscp_prio[app->protocol] = app->priority;
466 		(void)dcb_ieee_setapp(netdev, app);
467 		return ret;
468 	}
469 
470 	if (h->kinfo.dscp_app_cnt)
471 		h->kinfo.dscp_app_cnt--;
472 
473 	if (!h->kinfo.dscp_app_cnt) {
474 		vport->nic.kinfo.tc_map_mode = HNAE3_TC_MAP_MODE_PRIO;
475 		ret = hclge_up_to_tc_map(hdev);
476 	}
477 
478 	return ret;
479 }
480 
481 /* DCBX configuration */
hclge_getdcbx(struct hnae3_handle * h)482 static u8 hclge_getdcbx(struct hnae3_handle *h)
483 {
484 	struct hclge_vport *vport = hclge_get_vport(h);
485 	struct hclge_dev *hdev = vport->back;
486 
487 	if (h->kinfo.tc_info.mqprio_active)
488 		return 0;
489 
490 	return hdev->dcbx_cap;
491 }
492 
hclge_setdcbx(struct hnae3_handle * h,u8 mode)493 static u8 hclge_setdcbx(struct hnae3_handle *h, u8 mode)
494 {
495 	struct hclge_vport *vport = hclge_get_vport(h);
496 	struct net_device *netdev = h->kinfo.netdev;
497 	struct hclge_dev *hdev = vport->back;
498 
499 	netif_dbg(h, drv, netdev, "set dcbx: mode=%u\n", mode);
500 
501 	/* No support for LLD_MANAGED modes or CEE */
502 	if ((mode & DCB_CAP_DCBX_LLD_MANAGED) ||
503 	    (mode & DCB_CAP_DCBX_VER_CEE) ||
504 	    !(mode & DCB_CAP_DCBX_HOST))
505 		return 1;
506 
507 	hdev->dcbx_cap = mode;
508 
509 	return 0;
510 }
511 
hclge_mqprio_qopt_check(struct hclge_dev * hdev,struct tc_mqprio_qopt_offload * mqprio_qopt)512 static int hclge_mqprio_qopt_check(struct hclge_dev *hdev,
513 				   struct tc_mqprio_qopt_offload *mqprio_qopt)
514 {
515 	u16 queue_sum = 0;
516 	int ret;
517 	int i;
518 
519 	if (!mqprio_qopt->qopt.num_tc) {
520 		mqprio_qopt->qopt.num_tc = 1;
521 		return 0;
522 	}
523 
524 	ret = hclge_dcb_common_validate(hdev, mqprio_qopt->qopt.num_tc,
525 					mqprio_qopt->qopt.prio_tc_map);
526 	if (ret)
527 		return ret;
528 
529 	for (i = 0; i < mqprio_qopt->qopt.num_tc; i++) {
530 		if (!is_power_of_2(mqprio_qopt->qopt.count[i])) {
531 			dev_err(&hdev->pdev->dev,
532 				"qopt queue count must be power of 2\n");
533 			return -EINVAL;
534 		}
535 
536 		if (mqprio_qopt->qopt.count[i] > hdev->pf_rss_size_max) {
537 			dev_err(&hdev->pdev->dev,
538 				"qopt queue count should be no more than %u\n",
539 				hdev->pf_rss_size_max);
540 			return -EINVAL;
541 		}
542 
543 		if (mqprio_qopt->qopt.offset[i] != queue_sum) {
544 			dev_err(&hdev->pdev->dev,
545 				"qopt queue offset must start from 0, and being continuous\n");
546 			return -EINVAL;
547 		}
548 
549 		if (mqprio_qopt->min_rate[i] || mqprio_qopt->max_rate[i]) {
550 			dev_err(&hdev->pdev->dev,
551 				"qopt tx_rate is not supported\n");
552 			return -EOPNOTSUPP;
553 		}
554 
555 		queue_sum = mqprio_qopt->qopt.offset[i];
556 		queue_sum += mqprio_qopt->qopt.count[i];
557 	}
558 	if (hdev->vport[0].alloc_tqps < queue_sum) {
559 		dev_err(&hdev->pdev->dev,
560 			"qopt queue count sum should be less than %u\n",
561 			hdev->vport[0].alloc_tqps);
562 		return -EINVAL;
563 	}
564 
565 	return 0;
566 }
567 
hclge_sync_mqprio_qopt(struct hnae3_tc_info * tc_info,struct tc_mqprio_qopt_offload * mqprio_qopt)568 static void hclge_sync_mqprio_qopt(struct hnae3_tc_info *tc_info,
569 				   struct tc_mqprio_qopt_offload *mqprio_qopt)
570 {
571 	memset(tc_info, 0, sizeof(*tc_info));
572 	tc_info->num_tc = mqprio_qopt->qopt.num_tc;
573 	memcpy(tc_info->prio_tc, mqprio_qopt->qopt.prio_tc_map,
574 	       sizeof_field(struct hnae3_tc_info, prio_tc));
575 	memcpy(tc_info->tqp_count, mqprio_qopt->qopt.count,
576 	       sizeof_field(struct hnae3_tc_info, tqp_count));
577 	memcpy(tc_info->tqp_offset, mqprio_qopt->qopt.offset,
578 	       sizeof_field(struct hnae3_tc_info, tqp_offset));
579 }
580 
hclge_config_tc(struct hclge_dev * hdev,struct hnae3_tc_info * tc_info)581 static int hclge_config_tc(struct hclge_dev *hdev,
582 			   struct hnae3_tc_info *tc_info)
583 {
584 	int i;
585 
586 	hclge_tm_schd_info_update(hdev, tc_info->num_tc);
587 	for (i = 0; i < HNAE3_MAX_USER_PRIO; i++)
588 		hdev->tm_info.prio_tc[i] = tc_info->prio_tc[i];
589 
590 	return hclge_map_update(hdev);
591 }
592 
593 /* Set up TC for hardware offloaded mqprio in channel mode */
hclge_setup_tc(struct hnae3_handle * h,struct tc_mqprio_qopt_offload * mqprio_qopt)594 static int hclge_setup_tc(struct hnae3_handle *h,
595 			  struct tc_mqprio_qopt_offload *mqprio_qopt)
596 {
597 	struct hclge_vport *vport = hclge_get_vport(h);
598 	struct hnae3_knic_private_info *kinfo;
599 	struct hclge_dev *hdev = vport->back;
600 	struct hnae3_tc_info old_tc_info;
601 	u8 tc = mqprio_qopt->qopt.num_tc;
602 	int ret;
603 
604 	/* if client unregistered, it's not allowed to change
605 	 * mqprio configuration, which may cause uninit ring
606 	 * fail.
607 	 */
608 	if (!test_bit(HCLGE_STATE_NIC_REGISTERED, &hdev->state))
609 		return -EBUSY;
610 
611 	kinfo = &vport->nic.kinfo;
612 	if (kinfo->tc_info.dcb_ets_active)
613 		return -EINVAL;
614 
615 	ret = hclge_mqprio_qopt_check(hdev, mqprio_qopt);
616 	if (ret) {
617 		dev_err(&hdev->pdev->dev,
618 			"failed to check mqprio qopt params, ret = %d\n", ret);
619 		return ret;
620 	}
621 
622 	ret = hclge_notify_down_uinit(hdev);
623 	if (ret)
624 		return ret;
625 
626 	memcpy(&old_tc_info, &kinfo->tc_info, sizeof(old_tc_info));
627 	hclge_sync_mqprio_qopt(&kinfo->tc_info, mqprio_qopt);
628 	kinfo->tc_info.mqprio_active = tc > 0;
629 
630 	ret = hclge_config_tc(hdev, &kinfo->tc_info);
631 	if (ret)
632 		goto err_out;
633 
634 	return hclge_notify_init_up(hdev);
635 
636 err_out:
637 	if (!tc) {
638 		dev_warn(&hdev->pdev->dev,
639 			 "failed to destroy mqprio, will active after reset, ret = %d\n",
640 			 ret);
641 	} else {
642 		/* roll-back */
643 		memcpy(&kinfo->tc_info, &old_tc_info, sizeof(old_tc_info));
644 		if (hclge_config_tc(hdev, &kinfo->tc_info))
645 			dev_err(&hdev->pdev->dev,
646 				"failed to roll back tc configuration\n");
647 	}
648 	hclge_notify_init_up(hdev);
649 
650 	return ret;
651 }
652 
653 static const struct hnae3_dcb_ops hns3_dcb_ops = {
654 	.ieee_getets	= hclge_ieee_getets,
655 	.ieee_setets	= hclge_ieee_setets,
656 	.ieee_getpfc	= hclge_ieee_getpfc,
657 	.ieee_setpfc	= hclge_ieee_setpfc,
658 	.ieee_setapp    = hclge_ieee_setapp,
659 	.ieee_delapp    = hclge_ieee_delapp,
660 	.getdcbx	= hclge_getdcbx,
661 	.setdcbx	= hclge_setdcbx,
662 	.setup_tc	= hclge_setup_tc,
663 };
664 
hclge_dcb_ops_set(struct hclge_dev * hdev)665 void hclge_dcb_ops_set(struct hclge_dev *hdev)
666 {
667 	struct hclge_vport *vport = hdev->vport;
668 	struct hnae3_knic_private_info *kinfo;
669 
670 	/* Hdev does not support DCB or vport is
671 	 * not a pf, then dcb_ops is not set.
672 	 */
673 	if (!hnae3_dev_dcb_supported(hdev) ||
674 	    vport->vport_id != 0)
675 		return;
676 
677 	kinfo = &vport->nic.kinfo;
678 	kinfo->dcb_ops = &hns3_dcb_ops;
679 	hdev->dcbx_cap = DCB_CAP_DCBX_VER_IEEE | DCB_CAP_DCBX_HOST;
680 }
681