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 #define ETH_STATIC_REG	 1
22 #define ETH_DUMP_REG	 5
23 #define ETH_GSTRING_LEN	32
24 
25 static struct hns_mac_cb *hns_get_mac_cb(struct hnae_handle *handle)
26 {
27 	struct  hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
28 
29 	return vf_cb->mac_cb;
30 }
31 
32 /**
33  * hns_ae_map_eport_to_dport - translate enet port id to dsaf port id
34  * @port_id: enet port id
35  *: debug port 0-1, service port 2 -7 (dsaf mode only 2)
36  * return: dsaf port id
37  *: service ports 0 - 5, debug port 6-7
38  **/
39 static int hns_ae_map_eport_to_dport(u32 port_id)
40 {
41 	int port_index;
42 
43 	if (port_id < DSAF_DEBUG_NW_NUM)
44 		port_index = port_id + DSAF_SERVICE_PORT_NUM_PER_DSAF;
45 	else
46 		port_index = port_id - DSAF_DEBUG_NW_NUM;
47 
48 	return port_index;
49 }
50 
51 static struct dsaf_device *hns_ae_get_dsaf_dev(struct hnae_ae_dev *dev)
52 {
53 	return container_of(dev, struct dsaf_device, ae_dev);
54 }
55 
56 static struct hns_ppe_cb *hns_get_ppe_cb(struct hnae_handle *handle)
57 {
58 	int ppe_index;
59 	int ppe_common_index;
60 	struct ppe_common_cb *ppe_comm;
61 	struct  hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
62 
63 	if (vf_cb->port_index < DSAF_SERVICE_PORT_NUM_PER_DSAF) {
64 		ppe_index = vf_cb->port_index;
65 		ppe_common_index = 0;
66 	} else {
67 		ppe_index = 0;
68 		ppe_common_index =
69 			vf_cb->port_index - DSAF_SERVICE_PORT_NUM_PER_DSAF + 1;
70 	}
71 	ppe_comm = vf_cb->dsaf_dev->ppe_common[ppe_common_index];
72 	return &ppe_comm->ppe_cb[ppe_index];
73 }
74 
75 static int hns_ae_get_q_num_per_vf(
76 	struct dsaf_device *dsaf_dev, int port)
77 {
78 	int common_idx = hns_dsaf_get_comm_idx_by_port(port);
79 
80 	return dsaf_dev->rcb_common[common_idx]->max_q_per_vf;
81 }
82 
83 static int hns_ae_get_vf_num_per_port(
84 	struct dsaf_device *dsaf_dev, int port)
85 {
86 	int common_idx = hns_dsaf_get_comm_idx_by_port(port);
87 
88 	return dsaf_dev->rcb_common[common_idx]->max_vfn;
89 }
90 
91 static struct ring_pair_cb *hns_ae_get_base_ring_pair(
92 	struct dsaf_device *dsaf_dev, int port)
93 {
94 	int common_idx = hns_dsaf_get_comm_idx_by_port(port);
95 	struct rcb_common_cb *rcb_comm = dsaf_dev->rcb_common[common_idx];
96 	int q_num = rcb_comm->max_q_per_vf;
97 	int vf_num = rcb_comm->max_vfn;
98 
99 	if (common_idx == HNS_DSAF_COMM_SERVICE_NW_IDX)
100 		return &rcb_comm->ring_pair_cb[port * q_num * vf_num];
101 	else
102 		return &rcb_comm->ring_pair_cb[0];
103 }
104 
105 static struct ring_pair_cb *hns_ae_get_ring_pair(struct hnae_queue *q)
106 {
107 	return container_of(q, struct ring_pair_cb, q);
108 }
109 
110 struct hnae_handle *hns_ae_get_handle(struct hnae_ae_dev *dev,
111 				      u32 port_id)
112 {
113 	int port_idx;
114 	int vfnum_per_port;
115 	int qnum_per_vf;
116 	int i;
117 	struct dsaf_device *dsaf_dev;
118 	struct hnae_handle *ae_handle;
119 	struct ring_pair_cb *ring_pair_cb;
120 	struct hnae_vf_cb *vf_cb;
121 
122 	dsaf_dev = hns_ae_get_dsaf_dev(dev);
123 	port_idx = hns_ae_map_eport_to_dport(port_id);
124 
125 	ring_pair_cb = hns_ae_get_base_ring_pair(dsaf_dev, port_idx);
126 	vfnum_per_port = hns_ae_get_vf_num_per_port(dsaf_dev, port_idx);
127 	qnum_per_vf = hns_ae_get_q_num_per_vf(dsaf_dev, port_idx);
128 
129 	vf_cb = kzalloc(sizeof(*vf_cb) +
130 			qnum_per_vf * sizeof(struct hnae_queue *), GFP_KERNEL);
131 	if (unlikely(!vf_cb)) {
132 		dev_err(dsaf_dev->dev, "malloc vf_cb fail!\n");
133 		ae_handle = ERR_PTR(-ENOMEM);
134 		goto handle_err;
135 	}
136 	ae_handle = &vf_cb->ae_handle;
137 	/* ae_handle Init  */
138 	ae_handle->owner_dev = dsaf_dev->dev;
139 	ae_handle->dev = dev;
140 	ae_handle->q_num = qnum_per_vf;
141 
142 	/* find ring pair, and set vf id*/
143 	for (ae_handle->vf_id = 0;
144 		ae_handle->vf_id < vfnum_per_port; ae_handle->vf_id++) {
145 		if (!ring_pair_cb->used_by_vf)
146 			break;
147 		ring_pair_cb += qnum_per_vf;
148 	}
149 	if (ae_handle->vf_id >= vfnum_per_port) {
150 		dev_err(dsaf_dev->dev, "malloc queue fail!\n");
151 		ae_handle = ERR_PTR(-EINVAL);
152 		goto vf_id_err;
153 	}
154 
155 	ae_handle->qs = (struct hnae_queue **)(&ae_handle->qs + 1);
156 	for (i = 0; i < qnum_per_vf; i++) {
157 		ae_handle->qs[i] = &ring_pair_cb->q;
158 		ae_handle->qs[i]->rx_ring.q = ae_handle->qs[i];
159 		ae_handle->qs[i]->tx_ring.q = ae_handle->qs[i];
160 
161 		ring_pair_cb->used_by_vf = 1;
162 		if (port_idx < DSAF_SERVICE_PORT_NUM_PER_DSAF)
163 			ring_pair_cb->port_id_in_dsa = port_idx;
164 		else
165 			ring_pair_cb->port_id_in_dsa = 0;
166 
167 		ring_pair_cb++;
168 	}
169 
170 	vf_cb->dsaf_dev = dsaf_dev;
171 	vf_cb->port_index = port_idx;
172 	vf_cb->mac_cb = &dsaf_dev->mac_cb[port_idx];
173 
174 	ae_handle->phy_if = vf_cb->mac_cb->phy_if;
175 	ae_handle->phy_node = vf_cb->mac_cb->phy_node;
176 	ae_handle->if_support = vf_cb->mac_cb->if_support;
177 	ae_handle->port_type = vf_cb->mac_cb->mac_type;
178 
179 	return ae_handle;
180 vf_id_err:
181 	kfree(vf_cb);
182 handle_err:
183 	return ae_handle;
184 }
185 
186 static void hns_ae_put_handle(struct hnae_handle *handle)
187 {
188 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
189 	int i;
190 
191 	vf_cb->mac_cb	 = NULL;
192 
193 	kfree(vf_cb);
194 
195 	for (i = 0; i < handle->q_num; i++)
196 		hns_ae_get_ring_pair(handle->qs[i])->used_by_vf = 0;
197 }
198 
199 static void hns_ae_ring_enable_all(struct hnae_handle *handle, int val)
200 {
201 	int q_num = handle->q_num;
202 	int i;
203 
204 	for (i = 0; i < q_num; i++)
205 		hns_rcb_ring_enable_hw(handle->qs[i], val);
206 }
207 
208 static void hns_ae_init_queue(struct hnae_queue *q)
209 {
210 	struct ring_pair_cb *ring =
211 		container_of(q, struct ring_pair_cb, q);
212 
213 	hns_rcb_init_hw(ring);
214 }
215 
216 static void hns_ae_fini_queue(struct hnae_queue *q)
217 {
218 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(q->handle);
219 
220 	if (vf_cb->mac_cb->mac_type == HNAE_PORT_SERVICE)
221 		hns_rcb_reset_ring_hw(q);
222 }
223 
224 static int hns_ae_set_mac_address(struct hnae_handle *handle, void *p)
225 {
226 	int ret;
227 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
228 
229 	if (!p || !is_valid_ether_addr((const u8 *)p)) {
230 		dev_err(handle->owner_dev, "is not valid ether addr !\n");
231 		return -EADDRNOTAVAIL;
232 	}
233 
234 	ret = hns_mac_change_vf_addr(mac_cb, handle->vf_id, p);
235 	if (ret != 0) {
236 		dev_err(handle->owner_dev,
237 			"set_mac_address fail, ret=%d!\n", ret);
238 		return ret;
239 	}
240 
241 	return 0;
242 }
243 
244 static int hns_ae_set_multicast_one(struct hnae_handle *handle, void *addr)
245 {
246 	int ret;
247 	char *mac_addr = (char *)addr;
248 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
249 
250 	assert(mac_cb);
251 
252 	if (mac_cb->mac_type != HNAE_PORT_SERVICE)
253 		return 0;
254 
255 	ret = hns_mac_set_multi(mac_cb, mac_cb->mac_id, mac_addr, true);
256 	if (ret) {
257 		dev_err(handle->owner_dev,
258 			"mac add mul_mac:%pM port%d  fail, ret = %#x!\n",
259 			mac_addr, mac_cb->mac_id, ret);
260 		return ret;
261 	}
262 
263 	ret = hns_mac_set_multi(mac_cb, DSAF_BASE_INNER_PORT_NUM,
264 				mac_addr, true);
265 	if (ret)
266 		dev_err(handle->owner_dev,
267 			"mac add mul_mac:%pM port%d  fail, ret = %#x!\n",
268 			mac_addr, DSAF_BASE_INNER_PORT_NUM, ret);
269 
270 	return ret;
271 }
272 
273 static int hns_ae_set_mtu(struct hnae_handle *handle, int new_mtu)
274 {
275 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
276 
277 	return hns_mac_set_mtu(mac_cb, new_mtu);
278 }
279 
280 static void hns_ae_set_tso_stats(struct hnae_handle *handle, int enable)
281 {
282 	struct hns_ppe_cb *ppe_cb = hns_get_ppe_cb(handle);
283 
284 	hns_ppe_set_tso_enable(ppe_cb, enable);
285 }
286 
287 static int hns_ae_start(struct hnae_handle *handle)
288 {
289 	int ret;
290 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
291 
292 	ret = hns_mac_vm_config_bc_en(mac_cb, 0, true);
293 	if (ret)
294 		return ret;
295 
296 	hns_ae_ring_enable_all(handle, 1);
297 	msleep(100);
298 
299 	hns_mac_start(mac_cb);
300 
301 	return 0;
302 }
303 
304 void hns_ae_stop(struct hnae_handle *handle)
305 {
306 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
307 
308 	/* just clean tx fbd, neednot rx fbd*/
309 	hns_rcb_wait_fbd_clean(handle->qs, handle->q_num, RCB_INT_FLAG_TX);
310 
311 	msleep(20);
312 
313 	hns_mac_stop(mac_cb);
314 
315 	usleep_range(10000, 20000);
316 
317 	hns_ae_ring_enable_all(handle, 0);
318 
319 	(void)hns_mac_vm_config_bc_en(mac_cb, 0, false);
320 }
321 
322 static void hns_ae_reset(struct hnae_handle *handle)
323 {
324 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
325 
326 	if (vf_cb->mac_cb->mac_type == HNAE_PORT_DEBUG) {
327 		u8 ppe_common_index =
328 			vf_cb->port_index - DSAF_SERVICE_PORT_NUM_PER_DSAF + 1;
329 
330 		hns_mac_reset(vf_cb->mac_cb);
331 		hns_ppe_reset_common(vf_cb->dsaf_dev, ppe_common_index);
332 	}
333 }
334 
335 void hns_ae_toggle_ring_irq(struct hnae_ring *ring, u32 mask)
336 {
337 	u32 flag;
338 
339 	if (is_tx_ring(ring))
340 		flag = RCB_INT_FLAG_TX;
341 	else
342 		flag = RCB_INT_FLAG_RX;
343 
344 	hns_rcb_int_ctrl_hw(ring->q, flag, mask);
345 }
346 
347 static void hns_aev2_toggle_ring_irq(struct hnae_ring *ring, u32 mask)
348 {
349 	u32 flag;
350 
351 	if (is_tx_ring(ring))
352 		flag = RCB_INT_FLAG_TX;
353 	else
354 		flag = RCB_INT_FLAG_RX;
355 
356 	hns_rcbv2_int_ctrl_hw(ring->q, flag, mask);
357 }
358 
359 static void hns_ae_toggle_queue_status(struct hnae_queue *queue, u32 val)
360 {
361 	struct dsaf_device *dsaf_dev = hns_ae_get_dsaf_dev(queue->dev);
362 
363 	if (AE_IS_VER1(dsaf_dev->dsaf_ver))
364 		hns_rcb_int_clr_hw(queue, RCB_INT_FLAG_TX | RCB_INT_FLAG_RX);
365 	else
366 		hns_rcbv2_int_clr_hw(queue, RCB_INT_FLAG_TX | RCB_INT_FLAG_RX);
367 
368 	hns_rcb_start(queue, val);
369 }
370 
371 static int hns_ae_get_link_status(struct hnae_handle *handle)
372 {
373 	u32 link_status;
374 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
375 
376 	hns_mac_get_link_status(mac_cb, &link_status);
377 
378 	return !!link_status;
379 }
380 
381 static int hns_ae_get_mac_info(struct hnae_handle *handle,
382 			       u8 *auto_neg, u16 *speed, u8 *duplex)
383 {
384 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
385 
386 	return hns_mac_get_port_info(mac_cb, auto_neg, speed, duplex);
387 }
388 
389 static void hns_ae_adjust_link(struct hnae_handle *handle, int speed,
390 			       int duplex)
391 {
392 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
393 
394 	hns_mac_adjust_link(mac_cb, speed, duplex);
395 }
396 
397 static void hns_ae_get_ring_bdnum_limit(struct hnae_queue *queue,
398 					u32 *uplimit)
399 {
400 	*uplimit = HNS_RCB_RING_MAX_PENDING_BD;
401 }
402 
403 static void hns_ae_get_pauseparam(struct hnae_handle *handle,
404 				  u32 *auto_neg, u32 *rx_en, u32 *tx_en)
405 {
406 	assert(handle);
407 
408 	hns_mac_get_autoneg(hns_get_mac_cb(handle), auto_neg);
409 
410 	hns_mac_get_pauseparam(hns_get_mac_cb(handle), rx_en, tx_en);
411 }
412 
413 static int hns_ae_set_autoneg(struct hnae_handle *handle, u8 enable)
414 {
415 	assert(handle);
416 
417 	return hns_mac_set_autoneg(hns_get_mac_cb(handle), enable);
418 }
419 
420 static void hns_ae_set_promisc_mode(struct hnae_handle *handle, u32 en)
421 {
422 	hns_dsaf_set_promisc_mode(hns_ae_get_dsaf_dev(handle->dev), en);
423 }
424 
425 static int hns_ae_get_autoneg(struct hnae_handle *handle)
426 {
427 	u32     auto_neg;
428 
429 	assert(handle);
430 
431 	hns_mac_get_autoneg(hns_get_mac_cb(handle), &auto_neg);
432 
433 	return auto_neg;
434 }
435 
436 static int hns_ae_set_pauseparam(struct hnae_handle *handle,
437 				 u32 autoneg, u32 rx_en, u32 tx_en)
438 {
439 	struct hns_mac_cb *mac_cb = hns_get_mac_cb(handle);
440 	int ret;
441 
442 	ret = hns_mac_set_autoneg(mac_cb, autoneg);
443 	if (ret)
444 		return ret;
445 
446 	return hns_mac_set_pauseparam(mac_cb, rx_en, tx_en);
447 }
448 
449 static void hns_ae_get_coalesce_usecs(struct hnae_handle *handle,
450 				      u32 *tx_usecs, u32 *rx_usecs)
451 {
452 	int port;
453 
454 	port = hns_ae_map_eport_to_dport(handle->eport_id);
455 
456 	*tx_usecs = hns_rcb_get_coalesce_usecs(
457 		hns_ae_get_dsaf_dev(handle->dev),
458 		hns_dsaf_get_comm_idx_by_port(port));
459 	*rx_usecs = hns_rcb_get_coalesce_usecs(
460 		hns_ae_get_dsaf_dev(handle->dev),
461 		hns_dsaf_get_comm_idx_by_port(port));
462 }
463 
464 static void hns_ae_get_rx_max_coalesced_frames(struct hnae_handle *handle,
465 					       u32 *tx_frames, u32 *rx_frames)
466 {
467 	int port;
468 
469 	assert(handle);
470 
471 	port = hns_ae_map_eport_to_dport(handle->eport_id);
472 
473 	*tx_frames = hns_rcb_get_coalesced_frames(
474 		hns_ae_get_dsaf_dev(handle->dev), port);
475 	*rx_frames = hns_rcb_get_coalesced_frames(
476 		hns_ae_get_dsaf_dev(handle->dev), port);
477 }
478 
479 static void hns_ae_set_coalesce_usecs(struct hnae_handle *handle,
480 				      u32 timeout)
481 {
482 	int port;
483 
484 	assert(handle);
485 
486 	port = hns_ae_map_eport_to_dport(handle->eport_id);
487 
488 	hns_rcb_set_coalesce_usecs(hns_ae_get_dsaf_dev(handle->dev),
489 				   port, timeout);
490 }
491 
492 static int  hns_ae_set_coalesce_frames(struct hnae_handle *handle,
493 				       u32 coalesce_frames)
494 {
495 	int port;
496 	int ret;
497 
498 	assert(handle);
499 
500 	port = hns_ae_map_eport_to_dport(handle->eport_id);
501 
502 	ret = hns_rcb_set_coalesced_frames(hns_ae_get_dsaf_dev(handle->dev),
503 					   port, coalesce_frames);
504 	return ret;
505 }
506 
507 void hns_ae_update_stats(struct hnae_handle *handle,
508 			 struct net_device_stats *net_stats)
509 {
510 	int port;
511 	int idx;
512 	struct dsaf_device *dsaf_dev;
513 	struct hns_mac_cb *mac_cb;
514 	struct hns_ppe_cb *ppe_cb;
515 	struct hnae_queue *queue;
516 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
517 	u64 tx_bytes = 0, rx_bytes = 0, tx_packets = 0, rx_packets = 0;
518 	u64 rx_errors = 0, tx_errors = 0, tx_dropped = 0;
519 	u64 rx_missed_errors = 0;
520 
521 	dsaf_dev = hns_ae_get_dsaf_dev(handle->dev);
522 	if (!dsaf_dev)
523 		return;
524 	port = vf_cb->port_index;
525 	ppe_cb = hns_get_ppe_cb(handle);
526 	mac_cb = hns_get_mac_cb(handle);
527 
528 	for (idx = 0; idx < handle->q_num; idx++) {
529 		queue = handle->qs[idx];
530 		hns_rcb_update_stats(queue);
531 
532 		tx_bytes += queue->tx_ring.stats.tx_bytes;
533 		tx_packets += queue->tx_ring.stats.tx_pkts;
534 		rx_bytes += queue->rx_ring.stats.rx_bytes;
535 		rx_packets += queue->rx_ring.stats.rx_pkts;
536 
537 		rx_errors += queue->rx_ring.stats.err_pkt_len
538 				+ queue->rx_ring.stats.l2_err
539 				+ queue->rx_ring.stats.l3l4_csum_err;
540 	}
541 
542 	hns_ppe_update_stats(ppe_cb);
543 	rx_missed_errors = ppe_cb->hw_stats.rx_drop_no_buf;
544 	tx_errors += ppe_cb->hw_stats.tx_err_checksum
545 		+ ppe_cb->hw_stats.tx_err_fifo_empty;
546 
547 	if (mac_cb->mac_type == HNAE_PORT_SERVICE) {
548 		hns_dsaf_update_stats(dsaf_dev, port);
549 		/* for port upline direction, i.e., rx. */
550 		rx_missed_errors += dsaf_dev->hw_stats[port].bp_drop;
551 		rx_missed_errors += dsaf_dev->hw_stats[port].pad_drop;
552 		rx_missed_errors += dsaf_dev->hw_stats[port].crc_false;
553 
554 		/* for port downline direction, i.e., tx. */
555 		port = port + DSAF_PPE_INODE_BASE;
556 		hns_dsaf_update_stats(dsaf_dev, port);
557 		tx_dropped += dsaf_dev->hw_stats[port].bp_drop;
558 		tx_dropped += dsaf_dev->hw_stats[port].pad_drop;
559 		tx_dropped += dsaf_dev->hw_stats[port].crc_false;
560 		tx_dropped += dsaf_dev->hw_stats[port].rslt_drop;
561 		tx_dropped += dsaf_dev->hw_stats[port].vlan_drop;
562 		tx_dropped += dsaf_dev->hw_stats[port].stp_drop;
563 	}
564 
565 	hns_mac_update_stats(mac_cb);
566 	rx_errors += mac_cb->hw_stats.rx_fifo_overrun_err;
567 
568 	tx_errors += mac_cb->hw_stats.tx_bad_pkts
569 		+ mac_cb->hw_stats.tx_fragment_err
570 		+ mac_cb->hw_stats.tx_jabber_err
571 		+ mac_cb->hw_stats.tx_underrun_err
572 		+ mac_cb->hw_stats.tx_crc_err;
573 
574 	net_stats->tx_bytes = tx_bytes;
575 	net_stats->tx_packets = tx_packets;
576 	net_stats->rx_bytes = rx_bytes;
577 	net_stats->rx_dropped = 0;
578 	net_stats->rx_packets = rx_packets;
579 	net_stats->rx_errors = rx_errors;
580 	net_stats->tx_errors = tx_errors;
581 	net_stats->tx_dropped = tx_dropped;
582 	net_stats->rx_missed_errors = rx_missed_errors;
583 	net_stats->rx_crc_errors = mac_cb->hw_stats.rx_fcs_err;
584 	net_stats->rx_frame_errors = mac_cb->hw_stats.rx_align_err;
585 	net_stats->rx_fifo_errors = mac_cb->hw_stats.rx_fifo_overrun_err;
586 	net_stats->rx_length_errors = mac_cb->hw_stats.rx_len_err;
587 	net_stats->multicast = mac_cb->hw_stats.rx_mc_pkts;
588 }
589 
590 void hns_ae_get_stats(struct hnae_handle *handle, u64 *data)
591 {
592 	int idx;
593 	struct hns_mac_cb *mac_cb;
594 	struct hns_ppe_cb *ppe_cb;
595 	u64 *p = data;
596 	struct  hnae_vf_cb *vf_cb;
597 
598 	if (!handle || !data) {
599 		pr_err("hns_ae_get_stats NULL handle or data pointer!\n");
600 		return;
601 	}
602 
603 	vf_cb = hns_ae_get_vf_cb(handle);
604 	mac_cb = hns_get_mac_cb(handle);
605 	ppe_cb = hns_get_ppe_cb(handle);
606 
607 	for (idx = 0; idx < handle->q_num; idx++) {
608 		hns_rcb_get_stats(handle->qs[idx], p);
609 		p += hns_rcb_get_ring_sset_count((int)ETH_SS_STATS);
610 	}
611 
612 	hns_ppe_get_stats(ppe_cb, p);
613 	p += hns_ppe_get_sset_count((int)ETH_SS_STATS);
614 
615 	hns_mac_get_stats(mac_cb, p);
616 	p += hns_mac_get_sset_count(mac_cb, (int)ETH_SS_STATS);
617 
618 	if (mac_cb->mac_type == HNAE_PORT_SERVICE)
619 		hns_dsaf_get_stats(vf_cb->dsaf_dev, p, vf_cb->port_index);
620 }
621 
622 void hns_ae_get_strings(struct hnae_handle *handle,
623 			u32 stringset, u8 *data)
624 {
625 	int port;
626 	int idx;
627 	struct hns_mac_cb *mac_cb;
628 	struct hns_ppe_cb *ppe_cb;
629 	u8 *p = data;
630 	struct	hnae_vf_cb *vf_cb;
631 
632 	assert(handle);
633 
634 	vf_cb = hns_ae_get_vf_cb(handle);
635 	port = vf_cb->port_index;
636 	mac_cb = hns_get_mac_cb(handle);
637 	ppe_cb = hns_get_ppe_cb(handle);
638 
639 	for (idx = 0; idx < handle->q_num; idx++) {
640 		hns_rcb_get_strings(stringset, p, idx);
641 		p += ETH_GSTRING_LEN * hns_rcb_get_ring_sset_count(stringset);
642 	}
643 
644 	hns_ppe_get_strings(ppe_cb, stringset, p);
645 	p += ETH_GSTRING_LEN * hns_ppe_get_sset_count(stringset);
646 
647 	hns_mac_get_strings(mac_cb, stringset, p);
648 	p += ETH_GSTRING_LEN * hns_mac_get_sset_count(mac_cb, stringset);
649 
650 	if (mac_cb->mac_type == HNAE_PORT_SERVICE)
651 		hns_dsaf_get_strings(stringset, p, port);
652 }
653 
654 int hns_ae_get_sset_count(struct hnae_handle *handle, int stringset)
655 {
656 	u32 sset_count = 0;
657 	struct hns_mac_cb *mac_cb;
658 
659 	assert(handle);
660 
661 	mac_cb = hns_get_mac_cb(handle);
662 
663 	sset_count += hns_rcb_get_ring_sset_count(stringset) * handle->q_num;
664 	sset_count += hns_ppe_get_sset_count(stringset);
665 	sset_count += hns_mac_get_sset_count(mac_cb, stringset);
666 
667 	if (mac_cb->mac_type == HNAE_PORT_SERVICE)
668 		sset_count += hns_dsaf_get_sset_count(stringset);
669 
670 	return sset_count;
671 }
672 
673 static int hns_ae_config_loopback(struct hnae_handle *handle,
674 				  enum hnae_loop loop, int en)
675 {
676 	int ret;
677 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
678 
679 	switch (loop) {
680 	case MAC_INTERNALLOOP_SERDES:
681 		ret = hns_mac_config_sds_loopback(vf_cb->mac_cb, en);
682 		break;
683 	case MAC_INTERNALLOOP_MAC:
684 		ret = hns_mac_config_mac_loopback(vf_cb->mac_cb, loop, en);
685 		break;
686 	default:
687 		ret = -EINVAL;
688 	}
689 	return ret;
690 }
691 
692 void hns_ae_update_led_status(struct hnae_handle *handle)
693 {
694 	struct hns_mac_cb *mac_cb;
695 
696 	assert(handle);
697 	mac_cb = hns_get_mac_cb(handle);
698 	if (!mac_cb->cpld_vaddr)
699 		return;
700 	hns_set_led_opt(mac_cb);
701 }
702 
703 int hns_ae_cpld_set_led_id(struct hnae_handle *handle,
704 			   enum hnae_led_state status)
705 {
706 	struct hns_mac_cb *mac_cb;
707 
708 	assert(handle);
709 
710 	mac_cb = hns_get_mac_cb(handle);
711 
712 	return hns_cpld_led_set_id(mac_cb, status);
713 }
714 
715 void hns_ae_get_regs(struct hnae_handle *handle, void *data)
716 {
717 	u32 *p = data;
718 	u32 rcb_com_idx;
719 	int i;
720 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
721 	struct hns_ppe_cb *ppe_cb = hns_get_ppe_cb(handle);
722 
723 	hns_ppe_get_regs(ppe_cb, p);
724 	p += hns_ppe_get_regs_count();
725 
726 	rcb_com_idx = hns_dsaf_get_comm_idx_by_port(vf_cb->port_index);
727 	hns_rcb_get_common_regs(vf_cb->dsaf_dev->rcb_common[rcb_com_idx], p);
728 	p += hns_rcb_get_common_regs_count();
729 
730 	for (i = 0; i < handle->q_num; i++) {
731 		hns_rcb_get_ring_regs(handle->qs[i], p);
732 		p += hns_rcb_get_ring_regs_count();
733 	}
734 
735 	hns_mac_get_regs(vf_cb->mac_cb, p);
736 	p += hns_mac_get_regs_count(vf_cb->mac_cb);
737 
738 	if (vf_cb->mac_cb->mac_type == HNAE_PORT_SERVICE)
739 		hns_dsaf_get_regs(vf_cb->dsaf_dev, vf_cb->port_index, p);
740 }
741 
742 int hns_ae_get_regs_len(struct hnae_handle *handle)
743 {
744 	u32 total_num;
745 	struct hnae_vf_cb *vf_cb = hns_ae_get_vf_cb(handle);
746 
747 	total_num = hns_ppe_get_regs_count();
748 	total_num += hns_rcb_get_common_regs_count();
749 	total_num += hns_rcb_get_ring_regs_count() * handle->q_num;
750 	total_num += hns_mac_get_regs_count(vf_cb->mac_cb);
751 
752 	if (vf_cb->mac_cb->mac_type == HNAE_PORT_SERVICE)
753 		total_num += hns_dsaf_get_regs_count();
754 
755 	return total_num;
756 }
757 
758 static u32 hns_ae_get_rss_key_size(struct hnae_handle *handle)
759 {
760 	return HNS_PPEV2_RSS_KEY_SIZE;
761 }
762 
763 static u32 hns_ae_get_rss_indir_size(struct hnae_handle *handle)
764 {
765 	return HNS_PPEV2_RSS_IND_TBL_SIZE;
766 }
767 
768 static int hns_ae_get_rss(struct hnae_handle *handle, u32 *indir, u8 *key,
769 			  u8 *hfunc)
770 {
771 	struct hns_ppe_cb *ppe_cb = hns_get_ppe_cb(handle);
772 
773 	/* currently we support only one type of hash function i.e. Toep hash */
774 	if (hfunc)
775 		*hfunc = ETH_RSS_HASH_TOP;
776 
777 	/* get the RSS Key required by the user */
778 	if (key)
779 		memcpy(key, ppe_cb->rss_key, HNS_PPEV2_RSS_KEY_SIZE);
780 
781 	/* update the current hash->queue mappings from the shadow RSS table */
782 	memcpy(indir, ppe_cb->rss_indir_table, HNS_PPEV2_RSS_IND_TBL_SIZE);
783 
784 	return 0;
785 }
786 
787 static int hns_ae_set_rss(struct hnae_handle *handle, const u32 *indir,
788 			  const u8 *key, const u8 hfunc)
789 {
790 	struct hns_ppe_cb *ppe_cb = hns_get_ppe_cb(handle);
791 
792 	/* set the RSS Hash Key if specififed by the user */
793 	if (key)
794 		hns_ppe_set_rss_key(ppe_cb, (int *)key);
795 
796 	/* update the shadow RSS table with user specified qids */
797 	memcpy(ppe_cb->rss_indir_table, indir, HNS_PPEV2_RSS_IND_TBL_SIZE);
798 
799 	/* now update the hardware */
800 	hns_ppe_set_indir_table(ppe_cb, ppe_cb->rss_indir_table);
801 
802 	return 0;
803 }
804 
805 static struct hnae_ae_ops hns_dsaf_ops = {
806 	.get_handle = hns_ae_get_handle,
807 	.put_handle = hns_ae_put_handle,
808 	.init_queue = hns_ae_init_queue,
809 	.fini_queue = hns_ae_fini_queue,
810 	.start = hns_ae_start,
811 	.stop = hns_ae_stop,
812 	.reset = hns_ae_reset,
813 	.toggle_ring_irq = hns_ae_toggle_ring_irq,
814 	.toggle_queue_status = hns_ae_toggle_queue_status,
815 	.get_status = hns_ae_get_link_status,
816 	.get_info = hns_ae_get_mac_info,
817 	.adjust_link = hns_ae_adjust_link,
818 	.set_loopback = hns_ae_config_loopback,
819 	.get_ring_bdnum_limit = hns_ae_get_ring_bdnum_limit,
820 	.get_pauseparam = hns_ae_get_pauseparam,
821 	.set_autoneg = hns_ae_set_autoneg,
822 	.get_autoneg = hns_ae_get_autoneg,
823 	.set_pauseparam = hns_ae_set_pauseparam,
824 	.get_coalesce_usecs = hns_ae_get_coalesce_usecs,
825 	.get_rx_max_coalesced_frames = hns_ae_get_rx_max_coalesced_frames,
826 	.set_coalesce_usecs = hns_ae_set_coalesce_usecs,
827 	.set_coalesce_frames = hns_ae_set_coalesce_frames,
828 	.set_promisc_mode = hns_ae_set_promisc_mode,
829 	.set_mac_addr = hns_ae_set_mac_address,
830 	.set_mc_addr = hns_ae_set_multicast_one,
831 	.set_mtu = hns_ae_set_mtu,
832 	.update_stats = hns_ae_update_stats,
833 	.set_tso_stats = hns_ae_set_tso_stats,
834 	.get_stats = hns_ae_get_stats,
835 	.get_strings = hns_ae_get_strings,
836 	.get_sset_count = hns_ae_get_sset_count,
837 	.update_led_status = hns_ae_update_led_status,
838 	.set_led_id = hns_ae_cpld_set_led_id,
839 	.get_regs = hns_ae_get_regs,
840 	.get_regs_len = hns_ae_get_regs_len,
841 	.get_rss_key_size = hns_ae_get_rss_key_size,
842 	.get_rss_indir_size = hns_ae_get_rss_indir_size,
843 	.get_rss = hns_ae_get_rss,
844 	.set_rss = hns_ae_set_rss
845 };
846 
847 int hns_dsaf_ae_init(struct dsaf_device *dsaf_dev)
848 {
849 	struct hnae_ae_dev *ae_dev = &dsaf_dev->ae_dev;
850 
851 	switch (dsaf_dev->dsaf_ver) {
852 	case AE_VERSION_1:
853 		hns_dsaf_ops.toggle_ring_irq = hns_ae_toggle_ring_irq;
854 		break;
855 	case AE_VERSION_2:
856 		hns_dsaf_ops.toggle_ring_irq = hns_aev2_toggle_ring_irq;
857 		break;
858 	default:
859 		break;
860 	}
861 	ae_dev->ops = &hns_dsaf_ops;
862 	ae_dev->dev = dsaf_dev->dev;
863 
864 	return hnae_ae_register(ae_dev, THIS_MODULE);
865 }
866 
867 void hns_dsaf_ae_uninit(struct dsaf_device *dsaf_dev)
868 {
869 	hnae_ae_unregister(&dsaf_dev->ae_dev);
870 }
871