1 /*
2  * Copyright (c) 2014-2015 Hisilicon Limited.
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; either version 2 of the License, or
7  * (at your option) any later version.
8  */
9 
10 #include <linux/etherdevice.h>
11 #include <linux/netdevice.h>
12 #include <linux/spinlock.h>
13 
14 #include "hnae.h"
15 #include "hns_dsaf_mac.h"
16 #include "hns_dsaf_main.h"
17 #include "hns_dsaf_ppe.h"
18 #include "hns_dsaf_rcb.h"
19 
20 #define AE_NAME_PORT_ID_IDX 6
21 
hns_get_mac_cb(struct hnae_handle * handle)22 static struct hns_mac_cb *hns_get_mac_cb(struct hnae_handle *handle)
23 {
24 	struct  hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
25 
26 	return vf_cb->mac_cb;
27 }
28 
hns_ae_get_dsaf_dev(struct hnae_ae_dev * dev)29 static struct dsaf_device *hns_ae_get_dsaf_dev(struct hnae_ae_dev *dev)
30 {
31 	return container_of(dev, struct dsaf_device, ae_dev);
32 }
33 
hns_get_ppe_cb(struct hnae_handle * handle)34 static struct hns_ppe_cb *hns_get_ppe_cb(struct hnae_handle *handle)
35 {
36 	int ppe_index;
37 	struct ppe_common_cb *ppe_comm;
38 	struct  hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
39 
40 	ppe_comm = vf_cb->dsaf_dev->ppe_common[0];
41 	ppe_index = vf_cb->port_index;
42 
43 	return &ppe_comm->ppe_cb[ppe_index];
44 }
45 
hns_ae_get_q_num_per_vf(struct dsaf_device * dsaf_dev,int port)46 static int hns_ae_get_q_num_per_vf(
47 	struct dsaf_device *dsaf_dev, int port)
48 {
49 	return dsaf_dev->rcb_common[0]->max_q_per_vf;
50 }
51 
hns_ae_get_vf_num_per_port(struct dsaf_device * dsaf_dev,int port)52 static int hns_ae_get_vf_num_per_port(
53 	struct dsaf_device *dsaf_dev, int port)
54 {
55 	return dsaf_dev->rcb_common[0]->max_vfn;
56 }
57 
hns_ae_get_base_ring_pair(struct dsaf_device * dsaf_dev,int port)58 static struct ring_pair_cb *hns_ae_get_base_ring_pair(
59 	struct dsaf_device *dsaf_dev, int port)
60 {
61 	struct rcb_common_cb *rcb_comm = dsaf_dev->rcb_common[0];
62 	int q_num = rcb_comm->max_q_per_vf;
63 	int vf_num = rcb_comm->max_vfn;
64 
65 	return &rcb_comm->ring_pair_cb[port * q_num * vf_num];
66 }
67 
hns_ae_get_ring_pair(struct hnae_queue * q)68 static struct ring_pair_cb *hns_ae_get_ring_pair(struct hnae_queue *q)
69 {
70 	return container_of(q, struct ring_pair_cb, q);
71 }
72 
hns_ae_get_handle(struct hnae_ae_dev * dev,u32 port_id)73 static struct hnae_handle *hns_ae_get_handle(struct hnae_ae_dev *dev,
74 					     u32 port_id)
75 {
76 	int vfnum_per_port;
77 	int qnum_per_vf;
78 	int i;
79 	struct dsaf_device *dsaf_dev;
80 	struct hnae_handle *ae_handle;
81 	struct ring_pair_cb *ring_pair_cb;
82 	struct hnae_vf_cb *vf_cb;
83 
84 	dsaf_dev = hns_ae_get_dsaf_dev(dev);
85 
86 	ring_pair_cb = hns_ae_get_base_ring_pair(dsaf_dev, port_id);
87 	vfnum_per_port = hns_ae_get_vf_num_per_port(dsaf_dev, port_id);
88 	qnum_per_vf = hns_ae_get_q_num_per_vf(dsaf_dev, port_id);
89 
90 	vf_cb = kzalloc(sizeof(*vf_cb) +
91 			qnum_per_vf * sizeof(struct hnae_queue *), GFP_KERNEL);
92 	if (unlikely(!vf_cb)) {
93 		dev_err(dsaf_dev->dev, "malloc vf_cb fail!\n");
94 		ae_handle = ERR_PTR(-ENOMEM);
95 		goto handle_err;
96 	}
97 	ae_handle = &vf_cb->ae_handle;
98 	/* ae_handle Init  */
99 	ae_handle->owner_dev = dsaf_dev->dev;
100 	ae_handle->dev = dev;
101 	ae_handle->q_num = qnum_per_vf;
102 	ae_handle->coal_param = HNAE_LOWEST_LATENCY_COAL_PARAM;
103 
104 	/* find ring pair, and set vf id*/
105 	for (ae_handle->vf_id = 0;
106 		ae_handle->vf_id < vfnum_per_port; ae_handle->vf_id++) {
107 		if (!ring_pair_cb->used_by_vf)
108 			break;
109 		ring_pair_cb += qnum_per_vf;
110 	}
111 	if (ae_handle->vf_id >= vfnum_per_port) {
112 		dev_err(dsaf_dev->dev, "malloc queue fail!\n");
113 		ae_handle = ERR_PTR(-EINVAL);
114 		goto vf_id_err;
115 	}
116 
117 	ae_handle->qs = (struct hnae_queue **)(&ae_handle->qs + 1);
118 	for (i = 0; i < qnum_per_vf; i++) {
119 		ae_handle->qs[i] = &ring_pair_cb->q;
120 		ae_handle->qs[i]->rx_ring.q = ae_handle->qs[i];
121 		ae_handle->qs[i]->tx_ring.q = ae_handle->qs[i];
122 
123 		ring_pair_cb->used_by_vf = 1;
124 		ring_pair_cb++;
125 	}
126 
127 	vf_cb->dsaf_dev = dsaf_dev;
128 	vf_cb->port_index = port_id;
129 	vf_cb->mac_cb = dsaf_dev->mac_cb[port_id];
130 
131 	ae_handle->phy_if = vf_cb->mac_cb->phy_if;
132 	ae_handle->phy_dev = vf_cb->mac_cb->phy_dev;
133 	ae_handle->if_support = vf_cb->mac_cb->if_support;
134 	ae_handle->port_type = vf_cb->mac_cb->mac_type;
135 	ae_handle->media_type = vf_cb->mac_cb->media_type;
136 	ae_handle->dport_id = port_id;
137 
138 	return ae_handle;
139 vf_id_err:
140 	kfree(vf_cb);
141 handle_err:
142 	return ae_handle;
143 }
144 
hns_ae_put_handle(struct hnae_handle * handle)145 static void hns_ae_put_handle(struct hnae_handle *handle)
146 {
147 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
148 	int i;
149 
150 	vf_cb->mac_cb	 = NULL;
151 
152 	kfree(vf_cb);
153 
154 	for (i = 0; i < handle->q_num; i++)
155 		hns_ae_get_ring_pair(handle->qs[i])->used_by_vf = 0;
156 }
157 
hns_ae_wait_flow_down(struct hnae_handle * handle)158 static int hns_ae_wait_flow_down(struct hnae_handle *handle)
159 {
160 	struct dsaf_device *dsaf_dev;
161 	struct hns_ppe_cb *ppe_cb;
162 	struct hnae_vf_cb *vf_cb;
163 	int ret;
164 	int i;
165 
166 	for (i = 0; i < handle->q_num; i++) {
167 		ret = hns_rcb_wait_tx_ring_clean(handle->qs[i]);
168 		if (ret)
169 			return ret;
170 	}
171 
172 	ppe_cb = hns_get_ppe_cb(handle);
173 	ret = hns_ppe_wait_tx_fifo_clean(ppe_cb);
174 	if (ret)
175 		return ret;
176 
177 	dsaf_dev = hns_ae_get_dsaf_dev(handle->dev);
178 	if (!dsaf_dev)
179 		return -EINVAL;
180 	ret = hns_dsaf_wait_pkt_clean(dsaf_dev, handle->dport_id);
181 	if (ret)
182 		return ret;
183 
184 	vf_cb = hns_ae_get_vf_cb(handle);
185 	ret = hns_mac_wait_fifo_clean(vf_cb->mac_cb);
186 	if (ret)
187 		return ret;
188 
189 	mdelay(10);
190 	return 0;
191 }
192 
hns_ae_ring_enable_all(struct hnae_handle * handle,int val)193 static void hns_ae_ring_enable_all(struct hnae_handle *handle, int val)
194 {
195 	int q_num = handle->q_num;
196 	int i;
197 
198 	for (i = 0; i < q_num; i++)
199 		hns_rcb_ring_enable_hw(handle->qs[i], val);
200 }
201 
hns_ae_init_queue(struct hnae_queue * q)202 static void hns_ae_init_queue(struct hnae_queue *q)
203 {
204 	struct ring_pair_cb *ring =
205 		container_of(q, struct ring_pair_cb, q);
206 
207 	hns_rcb_init_hw(ring);
208 }
209 
hns_ae_fini_queue(struct hnae_queue * q)210 static void hns_ae_fini_queue(struct hnae_queue *q)
211 {
212 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(q->handle);
213 
214 	if (vf_cb->mac_cb->mac_type == HNAE_PORT_SERVICE)
215 		hns_rcb_reset_ring_hw(q);
216 }
217 
hns_ae_set_mac_address(struct hnae_handle * handle,void * p)218 static int hns_ae_set_mac_address(struct hnae_handle *handle, void *p)
219 {
220 	int ret;
221 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
222 
223 	if (!p || !is_valid_ether_addr((const u8 *)p)) {
224 		dev_err(handle->owner_dev, "is not valid ether addr !\n");
225 		return -EADDRNOTAVAIL;
226 	}
227 
228 	ret = hns_mac_change_vf_addr(mac_cb, handle->vf_id, p);
229 	if (ret != 0) {
230 		dev_err(handle->owner_dev,
231 			"set_mac_address fail, ret=%d!\n", ret);
232 		return ret;
233 	}
234 
235 	return 0;
236 }
237 
hns_ae_add_uc_address(struct hnae_handle * handle,const unsigned char * addr)238 static int hns_ae_add_uc_address(struct hnae_handle *handle,
239 				 const unsigned char *addr)
240 {
241 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
242 
243 	if (mac_cb->mac_type != HNAE_PORT_SERVICE)
244 		return -ENOSPC;
245 
246 	return hns_mac_add_uc_addr(mac_cb, handle->vf_id, addr);
247 }
248 
hns_ae_rm_uc_address(struct hnae_handle * handle,const unsigned char * addr)249 static int hns_ae_rm_uc_address(struct hnae_handle *handle,
250 				const unsigned char *addr)
251 {
252 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
253 
254 	if (mac_cb->mac_type != HNAE_PORT_SERVICE)
255 		return -ENOSPC;
256 
257 	return hns_mac_rm_uc_addr(mac_cb, handle->vf_id, addr);
258 }
259 
hns_ae_set_multicast_one(struct hnae_handle * handle,void * addr)260 static int hns_ae_set_multicast_one(struct hnae_handle *handle, void *addr)
261 {
262 	int ret;
263 	char *mac_addr = (char *)addr;
264 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
265 	u8 port_num;
266 
267 	assert(mac_cb);
268 
269 	if (mac_cb->mac_type != HNAE_PORT_SERVICE)
270 		return 0;
271 
272 	ret = hns_mac_set_multi(mac_cb, mac_cb->mac_id, mac_addr, true);
273 	if (ret) {
274 		dev_err(handle->owner_dev,
275 			"mac add mul_mac:%pM port%d  fail, ret = %#x!\n",
276 			mac_addr, mac_cb->mac_id, ret);
277 		return ret;
278 	}
279 
280 	ret = hns_mac_get_inner_port_num(mac_cb, handle->vf_id, &port_num);
281 	if (ret)
282 		return ret;
283 
284 	ret = hns_mac_set_multi(mac_cb, port_num, mac_addr, true);
285 	if (ret)
286 		dev_err(handle->owner_dev,
287 			"mac add mul_mac:%pM port%d  fail, ret = %#x!\n",
288 			mac_addr, DSAF_BASE_INNER_PORT_NUM, ret);
289 
290 	return ret;
291 }
292 
hns_ae_clr_multicast(struct hnae_handle * handle)293 static int hns_ae_clr_multicast(struct hnae_handle *handle)
294 {
295 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
296 
297 	if (mac_cb->mac_type != HNAE_PORT_SERVICE)
298 		return 0;
299 
300 	return hns_mac_clr_multicast(mac_cb, handle->vf_id);
301 }
302 
hns_ae_set_mtu(struct hnae_handle * handle,int new_mtu)303 static int hns_ae_set_mtu(struct hnae_handle *handle, int new_mtu)
304 {
305 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
306 	struct hnae_queue *q;
307 	u32 rx_buf_size;
308 	int i, ret;
309 
310 	/* when buf_size is 2048, max mtu is 6K for rx ring max bd num is 3. */
311 	if (!AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver)) {
312 		if (new_mtu <= BD_SIZE_2048_MAX_MTU)
313 			rx_buf_size = 2048;
314 		else
315 			rx_buf_size = 4096;
316 	} else {
317 		rx_buf_size = mac_cb->dsaf_dev->buf_size;
318 	}
319 
320 	ret = hns_mac_set_mtu(mac_cb, new_mtu, rx_buf_size);
321 
322 	if (!ret) {
323 		/* reinit ring buf_size */
324 		for (i = 0; i < handle->q_num; i++) {
325 			q = handle->qs[i];
326 			q->rx_ring.buf_size = rx_buf_size;
327 			hns_rcb_set_rx_ring_bs(q, rx_buf_size);
328 		}
329 	}
330 
331 	return ret;
332 }
333 
hns_ae_set_tso_stats(struct hnae_handle * handle,int enable)334 static void hns_ae_set_tso_stats(struct hnae_handle *handle, int enable)
335 {
336 	struct hns_ppe_cb *ppe_cb = hns_get_ppe_cb(handle);
337 
338 	hns_ppe_set_tso_enable(ppe_cb, enable);
339 }
340 
hns_ae_start(struct hnae_handle * handle)341 static int hns_ae_start(struct hnae_handle *handle)
342 {
343 	int ret;
344 	int k;
345 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
346 
347 	ret = hns_mac_vm_config_bc_en(mac_cb, 0, true);
348 	if (ret)
349 		return ret;
350 
351 	for (k = 0; k < handle->q_num; k++) {
352 		if (AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver))
353 			hns_rcb_int_clr_hw(handle->qs[k],
354 					   RCB_INT_FLAG_TX | RCB_INT_FLAG_RX);
355 		else
356 			hns_rcbv2_int_clr_hw(handle->qs[k],
357 					     RCB_INT_FLAG_TX | RCB_INT_FLAG_RX);
358 	}
359 	hns_ae_ring_enable_all(handle, 1);
360 	msleep(100);
361 
362 	hns_mac_start(mac_cb);
363 
364 	return 0;
365 }
366 
hns_ae_stop(struct hnae_handle * handle)367 static void hns_ae_stop(struct hnae_handle *handle)
368 {
369 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
370 
371 	/* just clean tx fbd, neednot rx fbd*/
372 	hns_rcb_wait_fbd_clean(handle->qs, handle->q_num, RCB_INT_FLAG_TX);
373 
374 	msleep(20);
375 
376 	hns_mac_stop(mac_cb);
377 
378 	usleep_range(10000, 20000);
379 
380 	hns_ae_ring_enable_all(handle, 0);
381 
382 	(void)hns_mac_vm_config_bc_en(mac_cb, 0, false);
383 }
384 
hns_ae_reset(struct hnae_handle * handle)385 static void hns_ae_reset(struct hnae_handle *handle)
386 {
387 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
388 
389 	if (vf_cb->mac_cb->mac_type == HNAE_PORT_DEBUG) {
390 		hns_mac_reset(vf_cb->mac_cb);
391 		hns_ppe_reset_common(vf_cb->dsaf_dev, 0);
392 	}
393 }
394 
hns_ae_toggle_ring_irq(struct hnae_ring * ring,u32 mask)395 static void hns_ae_toggle_ring_irq(struct hnae_ring *ring, u32 mask)
396 {
397 	u32 flag;
398 
399 	if (is_tx_ring(ring))
400 		flag = RCB_INT_FLAG_TX;
401 	else
402 		flag = RCB_INT_FLAG_RX;
403 
404 	hns_rcb_int_ctrl_hw(ring->q, flag, mask);
405 }
406 
hns_aev2_toggle_ring_irq(struct hnae_ring * ring,u32 mask)407 static void hns_aev2_toggle_ring_irq(struct hnae_ring *ring, u32 mask)
408 {
409 	u32 flag;
410 
411 	if (is_tx_ring(ring))
412 		flag = RCB_INT_FLAG_TX;
413 	else
414 		flag = RCB_INT_FLAG_RX;
415 
416 	hns_rcbv2_int_ctrl_hw(ring->q, flag, mask);
417 }
418 
hns_ae_get_link_status(struct hnae_handle * handle)419 static int hns_ae_get_link_status(struct hnae_handle *handle)
420 {
421 	u32 link_status;
422 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
423 
424 	hns_mac_get_link_status(mac_cb, &link_status);
425 
426 	return !!link_status;
427 }
428 
hns_ae_get_mac_info(struct hnae_handle * handle,u8 * auto_neg,u16 * speed,u8 * duplex)429 static int hns_ae_get_mac_info(struct hnae_handle *handle,
430 			       u8 *auto_neg, u16 *speed, u8 *duplex)
431 {
432 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
433 
434 	return hns_mac_get_port_info(mac_cb, auto_neg, speed, duplex);
435 }
436 
hns_ae_need_adjust_link(struct hnae_handle * handle,int speed,int duplex)437 static bool hns_ae_need_adjust_link(struct hnae_handle *handle, int speed,
438 				    int duplex)
439 {
440 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
441 
442 	return hns_mac_need_adjust_link(mac_cb, speed, duplex);
443 }
444 
hns_ae_adjust_link(struct hnae_handle * handle,int speed,int duplex)445 static void hns_ae_adjust_link(struct hnae_handle *handle, int speed,
446 			       int duplex)
447 {
448 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
449 
450 	switch (mac_cb->dsaf_dev->dsaf_ver) {
451 	case AE_VERSION_1:
452 		hns_mac_adjust_link(mac_cb, speed, duplex);
453 		break;
454 
455 	case AE_VERSION_2:
456 		/* chip need to clear all pkt inside */
457 		hns_mac_disable(mac_cb, MAC_COMM_MODE_RX);
458 		if (hns_ae_wait_flow_down(handle)) {
459 			hns_mac_enable(mac_cb, MAC_COMM_MODE_RX);
460 			break;
461 		}
462 
463 		hns_mac_adjust_link(mac_cb, speed, duplex);
464 		hns_mac_enable(mac_cb, MAC_COMM_MODE_RX);
465 		break;
466 
467 	default:
468 		break;
469 	}
470 
471 	return;
472 }
473 
hns_ae_get_ring_bdnum_limit(struct hnae_queue * queue,u32 * uplimit)474 static void hns_ae_get_ring_bdnum_limit(struct hnae_queue *queue,
475 					u32 *uplimit)
476 {
477 	*uplimit = HNS_RCB_RING_MAX_PENDING_BD;
478 }
479 
hns_ae_get_pauseparam(struct hnae_handle * handle,u32 * auto_neg,u32 * rx_en,u32 * tx_en)480 static void hns_ae_get_pauseparam(struct hnae_handle *handle,
481 				  u32 *auto_neg, u32 *rx_en, u32 *tx_en)
482 {
483 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
484 	struct dsaf_device *dsaf_dev = mac_cb->dsaf_dev;
485 
486 	hns_mac_get_autoneg(mac_cb, auto_neg);
487 
488 	hns_mac_get_pauseparam(mac_cb, rx_en, tx_en);
489 
490 	/* Service port's pause feature is provided by DSAF, not mac */
491 	if (handle->port_type == HNAE_PORT_SERVICE)
492 		hns_dsaf_get_rx_mac_pause_en(dsaf_dev, mac_cb->mac_id, rx_en);
493 }
494 
hns_ae_set_autoneg(struct hnae_handle * handle,u8 enable)495 static int hns_ae_set_autoneg(struct hnae_handle *handle, u8 enable)
496 {
497 	assert(handle);
498 
499 	return hns_mac_set_autoneg(hns_get_mac_cb(handle), enable);
500 }
501 
hns_ae_set_promisc_mode(struct hnae_handle * handle,u32 en)502 static void hns_ae_set_promisc_mode(struct hnae_handle *handle, u32 en)
503 {
504 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
505 
506 	hns_dsaf_set_promisc_mode(hns_ae_get_dsaf_dev(handle->dev), en);
507 	hns_mac_set_promisc(mac_cb, (u8)!!en);
508 }
509 
hns_ae_get_autoneg(struct hnae_handle * handle)510 static int hns_ae_get_autoneg(struct hnae_handle *handle)
511 {
512 	u32     auto_neg;
513 
514 	assert(handle);
515 
516 	hns_mac_get_autoneg(hns_get_mac_cb(handle), &auto_neg);
517 
518 	return auto_neg;
519 }
520 
hns_ae_set_pauseparam(struct hnae_handle * handle,u32 autoneg,u32 rx_en,u32 tx_en)521 static int hns_ae_set_pauseparam(struct hnae_handle *handle,
522 				 u32 autoneg, u32 rx_en, u32 tx_en)
523 {
524 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
525 	struct dsaf_device *dsaf_dev = mac_cb->dsaf_dev;
526 	int ret;
527 
528 	ret = hns_mac_set_autoneg(mac_cb, autoneg);
529 	if (ret)
530 		return ret;
531 
532 	/* Service port's pause feature is provided by DSAF, not mac */
533 	if (handle->port_type == HNAE_PORT_SERVICE) {
534 		ret = hns_dsaf_set_rx_mac_pause_en(dsaf_dev,
535 						   mac_cb->mac_id, rx_en);
536 		if (ret)
537 			return ret;
538 		rx_en = 0;
539 	}
540 	return hns_mac_set_pauseparam(mac_cb, rx_en, tx_en);
541 }
542 
hns_ae_get_coalesce_usecs(struct hnae_handle * handle,u32 * tx_usecs,u32 * rx_usecs)543 static void hns_ae_get_coalesce_usecs(struct hnae_handle *handle,
544 				      u32 *tx_usecs, u32 *rx_usecs)
545 {
546 	struct ring_pair_cb *ring_pair =
547 		container_of(handle->qs[0], struct ring_pair_cb, q);
548 
549 	*tx_usecs = hns_rcb_get_coalesce_usecs(ring_pair->rcb_common,
550 					       ring_pair->port_id_in_comm);
551 	*rx_usecs = hns_rcb_get_coalesce_usecs(ring_pair->rcb_common,
552 					       ring_pair->port_id_in_comm);
553 }
554 
hns_ae_get_max_coalesced_frames(struct hnae_handle * handle,u32 * tx_frames,u32 * rx_frames)555 static void hns_ae_get_max_coalesced_frames(struct hnae_handle *handle,
556 					    u32 *tx_frames, u32 *rx_frames)
557 {
558 	struct ring_pair_cb *ring_pair =
559 		container_of(handle->qs[0], struct ring_pair_cb, q);
560 	struct dsaf_device *dsaf_dev = hns_ae_get_dsaf_dev(handle->dev);
561 
562 	if (AE_IS_VER1(dsaf_dev->dsaf_ver) ||
563 	    handle->port_type == HNAE_PORT_DEBUG)
564 		*tx_frames = hns_rcb_get_rx_coalesced_frames(
565 			ring_pair->rcb_common, ring_pair->port_id_in_comm);
566 	else
567 		*tx_frames = hns_rcb_get_tx_coalesced_frames(
568 			ring_pair->rcb_common, ring_pair->port_id_in_comm);
569 	*rx_frames = hns_rcb_get_rx_coalesced_frames(ring_pair->rcb_common,
570 						  ring_pair->port_id_in_comm);
571 }
572 
hns_ae_set_coalesce_usecs(struct hnae_handle * handle,u32 timeout)573 static int hns_ae_set_coalesce_usecs(struct hnae_handle *handle,
574 				     u32 timeout)
575 {
576 	struct ring_pair_cb *ring_pair =
577 		container_of(handle->qs[0], struct ring_pair_cb, q);
578 
579 	return hns_rcb_set_coalesce_usecs(
580 		ring_pair->rcb_common, ring_pair->port_id_in_comm, timeout);
581 }
582 
hns_ae_set_coalesce_frames(struct hnae_handle * handle,u32 tx_frames,u32 rx_frames)583 static int hns_ae_set_coalesce_frames(struct hnae_handle *handle,
584 				      u32 tx_frames, u32 rx_frames)
585 {
586 	int ret;
587 	struct ring_pair_cb *ring_pair =
588 		container_of(handle->qs[0], struct ring_pair_cb, q);
589 	struct dsaf_device *dsaf_dev = hns_ae_get_dsaf_dev(handle->dev);
590 
591 	if (AE_IS_VER1(dsaf_dev->dsaf_ver) ||
592 	    handle->port_type == HNAE_PORT_DEBUG) {
593 		if (tx_frames != rx_frames)
594 			return -EINVAL;
595 		return hns_rcb_set_rx_coalesced_frames(
596 			ring_pair->rcb_common,
597 			ring_pair->port_id_in_comm, rx_frames);
598 	} else {
599 		if (tx_frames != 1)
600 			return -EINVAL;
601 		ret = hns_rcb_set_tx_coalesced_frames(
602 			ring_pair->rcb_common,
603 			ring_pair->port_id_in_comm, tx_frames);
604 		if (ret)
605 			return ret;
606 
607 		return hns_rcb_set_rx_coalesced_frames(
608 			ring_pair->rcb_common,
609 			ring_pair->port_id_in_comm, rx_frames);
610 	}
611 }
612 
hns_ae_get_coalesce_range(struct hnae_handle * handle,u32 * tx_frames_low,u32 * rx_frames_low,u32 * tx_frames_high,u32 * rx_frames_high,u32 * tx_usecs_low,u32 * rx_usecs_low,u32 * tx_usecs_high,u32 * rx_usecs_high)613 static void hns_ae_get_coalesce_range(struct hnae_handle *handle,
614 				      u32 *tx_frames_low, u32 *rx_frames_low,
615 				      u32 *tx_frames_high, u32 *rx_frames_high,
616 				      u32 *tx_usecs_low, u32 *rx_usecs_low,
617 				      u32 *tx_usecs_high, u32 *rx_usecs_high)
618 {
619 	struct dsaf_device *dsaf_dev;
620 
621 	assert(handle);
622 
623 	dsaf_dev = hns_ae_get_dsaf_dev(handle->dev);
624 
625 	*tx_frames_low  = HNS_RCB_TX_FRAMES_LOW;
626 	*rx_frames_low  = HNS_RCB_RX_FRAMES_LOW;
627 
628 	if (AE_IS_VER1(dsaf_dev->dsaf_ver) ||
629 	    handle->port_type == HNAE_PORT_DEBUG)
630 		*tx_frames_high =
631 			(dsaf_dev->desc_num - 1 > HNS_RCB_TX_FRAMES_HIGH) ?
632 			HNS_RCB_TX_FRAMES_HIGH : dsaf_dev->desc_num - 1;
633 	else
634 		*tx_frames_high = 1;
635 
636 	*rx_frames_high = (dsaf_dev->desc_num - 1 > HNS_RCB_RX_FRAMES_HIGH) ?
637 		HNS_RCB_RX_FRAMES_HIGH : dsaf_dev->desc_num - 1;
638 	*tx_usecs_low   = HNS_RCB_TX_USECS_LOW;
639 	*rx_usecs_low   = HNS_RCB_RX_USECS_LOW;
640 	*tx_usecs_high  = HNS_RCB_TX_USECS_HIGH;
641 	*rx_usecs_high  = HNS_RCB_RX_USECS_HIGH;
642 }
643 
hns_ae_update_stats(struct hnae_handle * handle,struct net_device_stats * net_stats)644 static void hns_ae_update_stats(struct hnae_handle *handle,
645 				struct net_device_stats *net_stats)
646 {
647 	int port;
648 	int idx;
649 	struct dsaf_device *dsaf_dev;
650 	struct hns_mac_cb *mac_cb;
651 	struct hns_ppe_cb *ppe_cb;
652 	struct hnae_queue *queue;
653 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
654 	u64 tx_bytes = 0, rx_bytes = 0, tx_packets = 0, rx_packets = 0;
655 	u64 rx_errors = 0, tx_errors = 0, tx_dropped = 0;
656 	u64 rx_missed_errors = 0;
657 
658 	dsaf_dev = hns_ae_get_dsaf_dev(handle->dev);
659 	if (!dsaf_dev)
660 		return;
661 	port = vf_cb->port_index;
662 	ppe_cb = hns_get_ppe_cb(handle);
663 	mac_cb = hns_get_mac_cb(handle);
664 
665 	for (idx = 0; idx < handle->q_num; idx++) {
666 		queue = handle->qs[idx];
667 		hns_rcb_update_stats(queue);
668 
669 		tx_bytes += queue->tx_ring.stats.tx_bytes;
670 		tx_packets += queue->tx_ring.stats.tx_pkts;
671 		rx_bytes += queue->rx_ring.stats.rx_bytes;
672 		rx_packets += queue->rx_ring.stats.rx_pkts;
673 
674 		rx_errors += queue->rx_ring.stats.err_pkt_len
675 				+ queue->rx_ring.stats.l2_err
676 				+ queue->rx_ring.stats.l3l4_csum_err;
677 	}
678 
679 	hns_ppe_update_stats(ppe_cb);
680 	rx_missed_errors = ppe_cb->hw_stats.rx_drop_no_buf;
681 	tx_errors += ppe_cb->hw_stats.tx_err_checksum
682 		+ ppe_cb->hw_stats.tx_err_fifo_empty;
683 
684 	if (mac_cb->mac_type == HNAE_PORT_SERVICE) {
685 		hns_dsaf_update_stats(dsaf_dev, port);
686 		/* for port upline direction, i.e., rx. */
687 		rx_missed_errors += dsaf_dev->hw_stats[port].bp_drop;
688 		rx_missed_errors += dsaf_dev->hw_stats[port].pad_drop;
689 		rx_missed_errors += dsaf_dev->hw_stats[port].crc_false;
690 
691 		/* for port downline direction, i.e., tx. */
692 		port = port + DSAF_PPE_INODE_BASE;
693 		hns_dsaf_update_stats(dsaf_dev, port);
694 		tx_dropped += dsaf_dev->hw_stats[port].bp_drop;
695 		tx_dropped += dsaf_dev->hw_stats[port].pad_drop;
696 		tx_dropped += dsaf_dev->hw_stats[port].crc_false;
697 		tx_dropped += dsaf_dev->hw_stats[port].rslt_drop;
698 		tx_dropped += dsaf_dev->hw_stats[port].vlan_drop;
699 		tx_dropped += dsaf_dev->hw_stats[port].stp_drop;
700 	}
701 
702 	hns_mac_update_stats(mac_cb);
703 	rx_errors += mac_cb->hw_stats.rx_fifo_overrun_err;
704 
705 	tx_errors += mac_cb->hw_stats.tx_bad_pkts
706 		+ mac_cb->hw_stats.tx_fragment_err
707 		+ mac_cb->hw_stats.tx_jabber_err
708 		+ mac_cb->hw_stats.tx_underrun_err
709 		+ mac_cb->hw_stats.tx_crc_err;
710 
711 	net_stats->tx_bytes = tx_bytes;
712 	net_stats->tx_packets = tx_packets;
713 	net_stats->rx_bytes = rx_bytes;
714 	net_stats->rx_dropped = 0;
715 	net_stats->rx_packets = rx_packets;
716 	net_stats->rx_errors = rx_errors;
717 	net_stats->tx_errors = tx_errors;
718 	net_stats->tx_dropped = tx_dropped;
719 	net_stats->rx_missed_errors = rx_missed_errors;
720 	net_stats->rx_crc_errors = mac_cb->hw_stats.rx_fcs_err;
721 	net_stats->rx_frame_errors = mac_cb->hw_stats.rx_align_err;
722 	net_stats->rx_fifo_errors = mac_cb->hw_stats.rx_fifo_overrun_err;
723 	net_stats->rx_length_errors = mac_cb->hw_stats.rx_len_err;
724 	net_stats->multicast = mac_cb->hw_stats.rx_mc_pkts;
725 }
726 
hns_ae_get_stats(struct hnae_handle * handle,u64 * data)727 static void hns_ae_get_stats(struct hnae_handle *handle, u64 *data)
728 {
729 	int idx;
730 	struct hns_mac_cb *mac_cb;
731 	struct hns_ppe_cb *ppe_cb;
732 	u64 *p = data;
733 	struct  hnae_vf_cb *vf_cb;
734 
735 	if (!handle || !data) {
736 		pr_err("hns_ae_get_stats NULL handle or data pointer!\n");
737 		return;
738 	}
739 
740 	vf_cb = hns_ae_get_vf_cb(handle);
741 	mac_cb = hns_get_mac_cb(handle);
742 	ppe_cb = hns_get_ppe_cb(handle);
743 
744 	for (idx = 0; idx < handle->q_num; idx++) {
745 		hns_rcb_get_stats(handle->qs[idx], p);
746 		p += hns_rcb_get_ring_sset_count((int)ETH_SS_STATS);
747 	}
748 
749 	hns_ppe_get_stats(ppe_cb, p);
750 	p += hns_ppe_get_sset_count((int)ETH_SS_STATS);
751 
752 	hns_mac_get_stats(mac_cb, p);
753 	p += hns_mac_get_sset_count(mac_cb, (int)ETH_SS_STATS);
754 
755 	if (mac_cb->mac_type == HNAE_PORT_SERVICE)
756 		hns_dsaf_get_stats(vf_cb->dsaf_dev, p, vf_cb->port_index);
757 }
758 
hns_ae_get_strings(struct hnae_handle * handle,u32 stringset,u8 * data)759 static void hns_ae_get_strings(struct hnae_handle *handle,
760 			       u32 stringset, u8 *data)
761 {
762 	int port;
763 	int idx;
764 	struct hns_mac_cb *mac_cb;
765 	struct hns_ppe_cb *ppe_cb;
766 	struct dsaf_device *dsaf_dev = hns_ae_get_dsaf_dev(handle->dev);
767 	u8 *p = data;
768 	struct	hnae_vf_cb *vf_cb;
769 
770 	assert(handle);
771 
772 	vf_cb = hns_ae_get_vf_cb(handle);
773 	port = vf_cb->port_index;
774 	mac_cb = hns_get_mac_cb(handle);
775 	ppe_cb = hns_get_ppe_cb(handle);
776 
777 	for (idx = 0; idx < handle->q_num; idx++) {
778 		hns_rcb_get_strings(stringset, p, idx);
779 		p += ETH_GSTRING_LEN * hns_rcb_get_ring_sset_count(stringset);
780 	}
781 
782 	hns_ppe_get_strings(ppe_cb, stringset, p);
783 	p += ETH_GSTRING_LEN * hns_ppe_get_sset_count(stringset);
784 
785 	hns_mac_get_strings(mac_cb, stringset, p);
786 	p += ETH_GSTRING_LEN * hns_mac_get_sset_count(mac_cb, stringset);
787 
788 	if (mac_cb->mac_type == HNAE_PORT_SERVICE)
789 		hns_dsaf_get_strings(stringset, p, port, dsaf_dev);
790 }
791 
hns_ae_get_sset_count(struct hnae_handle * handle,int stringset)792 static int hns_ae_get_sset_count(struct hnae_handle *handle, int stringset)
793 {
794 	u32 sset_count = 0;
795 	struct hns_mac_cb *mac_cb;
796 	struct dsaf_device *dsaf_dev = hns_ae_get_dsaf_dev(handle->dev);
797 
798 	assert(handle);
799 
800 	mac_cb = hns_get_mac_cb(handle);
801 
802 	sset_count += hns_rcb_get_ring_sset_count(stringset) * handle->q_num;
803 	sset_count += hns_ppe_get_sset_count(stringset);
804 	sset_count += hns_mac_get_sset_count(mac_cb, stringset);
805 
806 	if (mac_cb->mac_type == HNAE_PORT_SERVICE)
807 		sset_count += hns_dsaf_get_sset_count(dsaf_dev, stringset);
808 
809 	return sset_count;
810 }
811 
hns_ae_config_loopback(struct hnae_handle * handle,enum hnae_loop loop,int en)812 static int hns_ae_config_loopback(struct hnae_handle *handle,
813 				  enum hnae_loop loop, int en)
814 {
815 	int ret;
816 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
817 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
818 	struct dsaf_device *dsaf_dev = mac_cb->dsaf_dev;
819 
820 	switch (loop) {
821 	case MAC_INTERNALLOOP_PHY:
822 		ret = 0;
823 		break;
824 	case MAC_INTERNALLOOP_SERDES:
825 		ret = dsaf_dev->misc_op->cfg_serdes_loopback(vf_cb->mac_cb,
826 							     !!en);
827 		break;
828 	case MAC_INTERNALLOOP_MAC:
829 		ret = hns_mac_config_mac_loopback(vf_cb->mac_cb, loop, en);
830 		break;
831 	default:
832 		ret = -EINVAL;
833 	}
834 
835 	return ret;
836 }
837 
hns_ae_update_led_status(struct hnae_handle * handle)838 static void hns_ae_update_led_status(struct hnae_handle *handle)
839 {
840 	struct hns_mac_cb *mac_cb;
841 
842 	assert(handle);
843 	mac_cb = hns_get_mac_cb(handle);
844 	if (mac_cb->media_type != HNAE_MEDIA_TYPE_FIBER)
845 		return;
846 
847 	hns_set_led_opt(mac_cb);
848 }
849 
hns_ae_cpld_set_led_id(struct hnae_handle * handle,enum hnae_led_state status)850 static int hns_ae_cpld_set_led_id(struct hnae_handle *handle,
851 				  enum hnae_led_state status)
852 {
853 	struct hns_mac_cb *mac_cb;
854 
855 	assert(handle);
856 
857 	mac_cb = hns_get_mac_cb(handle);
858 
859 	return hns_cpld_led_set_id(mac_cb, status);
860 }
861 
hns_ae_get_regs(struct hnae_handle * handle,void * data)862 static void hns_ae_get_regs(struct hnae_handle *handle, void *data)
863 {
864 	u32 *p = data;
865 	int i;
866 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
867 	struct hns_ppe_cb *ppe_cb = hns_get_ppe_cb(handle);
868 
869 	hns_ppe_get_regs(ppe_cb, p);
870 	p += hns_ppe_get_regs_count();
871 
872 	hns_rcb_get_common_regs(vf_cb->dsaf_dev->rcb_common[0], p);
873 	p += hns_rcb_get_common_regs_count();
874 
875 	for (i = 0; i < handle->q_num; i++) {
876 		hns_rcb_get_ring_regs(handle->qs[i], p);
877 		p += hns_rcb_get_ring_regs_count();
878 	}
879 
880 	hns_mac_get_regs(vf_cb->mac_cb, p);
881 	p += hns_mac_get_regs_count(vf_cb->mac_cb);
882 
883 	if (vf_cb->mac_cb->mac_type == HNAE_PORT_SERVICE)
884 		hns_dsaf_get_regs(vf_cb->dsaf_dev, vf_cb->port_index, p);
885 }
886 
hns_ae_get_regs_len(struct hnae_handle * handle)887 static int hns_ae_get_regs_len(struct hnae_handle *handle)
888 {
889 	u32 total_num;
890 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
891 
892 	total_num = hns_ppe_get_regs_count();
893 	total_num += hns_rcb_get_common_regs_count();
894 	total_num += hns_rcb_get_ring_regs_count() * handle->q_num;
895 	total_num += hns_mac_get_regs_count(vf_cb->mac_cb);
896 
897 	if (vf_cb->mac_cb->mac_type == HNAE_PORT_SERVICE)
898 		total_num += hns_dsaf_get_regs_count();
899 
900 	return total_num;
901 }
902 
hns_ae_get_rss_key_size(struct hnae_handle * handle)903 static u32 hns_ae_get_rss_key_size(struct hnae_handle *handle)
904 {
905 	return HNS_PPEV2_RSS_KEY_SIZE;
906 }
907 
hns_ae_get_rss_indir_size(struct hnae_handle * handle)908 static u32 hns_ae_get_rss_indir_size(struct hnae_handle *handle)
909 {
910 	return HNS_PPEV2_RSS_IND_TBL_SIZE;
911 }
912 
hns_ae_get_rss(struct hnae_handle * handle,u32 * indir,u8 * key,u8 * hfunc)913 static int hns_ae_get_rss(struct hnae_handle *handle, u32 *indir, u8 *key,
914 			  u8 *hfunc)
915 {
916 	struct hns_ppe_cb *ppe_cb = hns_get_ppe_cb(handle);
917 
918 	/* currently we support only one type of hash function i.e. Toep hash */
919 	if (hfunc)
920 		*hfunc = ETH_RSS_HASH_TOP;
921 
922 	/* get the RSS Key required by the user */
923 	if (key)
924 		memcpy(key, ppe_cb->rss_key, HNS_PPEV2_RSS_KEY_SIZE);
925 
926 	/* update the current hash->queue mappings from the shadow RSS table */
927 	if (indir)
928 		memcpy(indir, ppe_cb->rss_indir_table,
929 		       HNS_PPEV2_RSS_IND_TBL_SIZE  * sizeof(*indir));
930 
931 	return 0;
932 }
933 
hns_ae_set_rss(struct hnae_handle * handle,const u32 * indir,const u8 * key,const u8 hfunc)934 static int hns_ae_set_rss(struct hnae_handle *handle, const u32 *indir,
935 			  const u8 *key, const u8 hfunc)
936 {
937 	struct hns_ppe_cb *ppe_cb = hns_get_ppe_cb(handle);
938 
939 	/* set the RSS Hash Key if specififed by the user */
940 	if (key) {
941 		memcpy(ppe_cb->rss_key, key, HNS_PPEV2_RSS_KEY_SIZE);
942 		hns_ppe_set_rss_key(ppe_cb, ppe_cb->rss_key);
943 	}
944 
945 	if (indir) {
946 		/* update the shadow RSS table with user specified qids */
947 		memcpy(ppe_cb->rss_indir_table, indir,
948 		       HNS_PPEV2_RSS_IND_TBL_SIZE  * sizeof(*indir));
949 
950 		/* now update the hardware */
951 		hns_ppe_set_indir_table(ppe_cb, ppe_cb->rss_indir_table);
952 	}
953 
954 	return 0;
955 }
956 
957 static struct hnae_ae_ops hns_dsaf_ops = {
958 	.get_handle = hns_ae_get_handle,
959 	.put_handle = hns_ae_put_handle,
960 	.init_queue = hns_ae_init_queue,
961 	.fini_queue = hns_ae_fini_queue,
962 	.start = hns_ae_start,
963 	.stop = hns_ae_stop,
964 	.reset = hns_ae_reset,
965 	.toggle_ring_irq = hns_ae_toggle_ring_irq,
966 	.get_status = hns_ae_get_link_status,
967 	.get_info = hns_ae_get_mac_info,
968 	.adjust_link = hns_ae_adjust_link,
969 	.need_adjust_link = hns_ae_need_adjust_link,
970 	.set_loopback = hns_ae_config_loopback,
971 	.get_ring_bdnum_limit = hns_ae_get_ring_bdnum_limit,
972 	.get_pauseparam = hns_ae_get_pauseparam,
973 	.set_autoneg = hns_ae_set_autoneg,
974 	.get_autoneg = hns_ae_get_autoneg,
975 	.set_pauseparam = hns_ae_set_pauseparam,
976 	.get_coalesce_usecs = hns_ae_get_coalesce_usecs,
977 	.get_max_coalesced_frames = hns_ae_get_max_coalesced_frames,
978 	.set_coalesce_usecs = hns_ae_set_coalesce_usecs,
979 	.set_coalesce_frames = hns_ae_set_coalesce_frames,
980 	.get_coalesce_range = hns_ae_get_coalesce_range,
981 	.set_promisc_mode = hns_ae_set_promisc_mode,
982 	.set_mac_addr = hns_ae_set_mac_address,
983 	.add_uc_addr = hns_ae_add_uc_address,
984 	.rm_uc_addr = hns_ae_rm_uc_address,
985 	.set_mc_addr = hns_ae_set_multicast_one,
986 	.clr_mc_addr = hns_ae_clr_multicast,
987 	.set_mtu = hns_ae_set_mtu,
988 	.update_stats = hns_ae_update_stats,
989 	.set_tso_stats = hns_ae_set_tso_stats,
990 	.get_stats = hns_ae_get_stats,
991 	.get_strings = hns_ae_get_strings,
992 	.get_sset_count = hns_ae_get_sset_count,
993 	.update_led_status = hns_ae_update_led_status,
994 	.set_led_id = hns_ae_cpld_set_led_id,
995 	.get_regs = hns_ae_get_regs,
996 	.get_regs_len = hns_ae_get_regs_len,
997 	.get_rss_key_size = hns_ae_get_rss_key_size,
998 	.get_rss_indir_size = hns_ae_get_rss_indir_size,
999 	.get_rss = hns_ae_get_rss,
1000 	.set_rss = hns_ae_set_rss
1001 };
1002 
hns_dsaf_ae_init(struct dsaf_device * dsaf_dev)1003 int hns_dsaf_ae_init(struct dsaf_device *dsaf_dev)
1004 {
1005 	struct hnae_ae_dev *ae_dev = &dsaf_dev->ae_dev;
1006 	static atomic_t id = ATOMIC_INIT(-1);
1007 
1008 	switch (dsaf_dev->dsaf_ver) {
1009 	case AE_VERSION_1:
1010 		hns_dsaf_ops.toggle_ring_irq = hns_ae_toggle_ring_irq;
1011 		break;
1012 	case AE_VERSION_2:
1013 		hns_dsaf_ops.toggle_ring_irq = hns_aev2_toggle_ring_irq;
1014 		break;
1015 	default:
1016 		break;
1017 	}
1018 
1019 	snprintf(ae_dev->name, AE_NAME_SIZE, "%s%d", DSAF_DEVICE_NAME,
1020 		 (int)atomic_inc_return(&id));
1021 	ae_dev->ops = &hns_dsaf_ops;
1022 	ae_dev->dev = dsaf_dev->dev;
1023 
1024 	return hnae_ae_register(ae_dev, THIS_MODULE);
1025 }
1026 
hns_dsaf_ae_uninit(struct dsaf_device * dsaf_dev)1027 void hns_dsaf_ae_uninit(struct dsaf_device *dsaf_dev)
1028 {
1029 	hnae_ae_unregister(&dsaf_dev->ae_dev);
1030 }
1031