1 // SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
2 /* Copyright 2013-2016 Freescale Semiconductor Inc.
3  * Copyright 2016 NXP
4  */
5 #include <linux/kernel.h>
6 #include <linux/errno.h>
7 #include <linux/fsl/mc.h>
8 #include "dpni.h"
9 #include "dpni-cmd.h"
10 
11 /**
12  * dpni_prepare_key_cfg() - function prepare extract parameters
13  * @cfg: defining a full Key Generation profile (rule)
14  * @key_cfg_buf: Zeroed 256 bytes of memory before mapping it to DMA
15  *
16  * This function has to be called before the following functions:
17  *	- dpni_set_rx_tc_dist()
18  *	- dpni_set_qos_table()
19  */
20 int dpni_prepare_key_cfg(const struct dpkg_profile_cfg *cfg, u8 *key_cfg_buf)
21 {
22 	int i, j;
23 	struct dpni_ext_set_rx_tc_dist *dpni_ext;
24 	struct dpni_dist_extract *extr;
25 
26 	if (cfg->num_extracts > DPKG_MAX_NUM_OF_EXTRACTS)
27 		return -EINVAL;
28 
29 	dpni_ext = (struct dpni_ext_set_rx_tc_dist *)key_cfg_buf;
30 	dpni_ext->num_extracts = cfg->num_extracts;
31 
32 	for (i = 0; i < cfg->num_extracts; i++) {
33 		extr = &dpni_ext->extracts[i];
34 
35 		switch (cfg->extracts[i].type) {
36 		case DPKG_EXTRACT_FROM_HDR:
37 			extr->prot = cfg->extracts[i].extract.from_hdr.prot;
38 			dpni_set_field(extr->efh_type, EFH_TYPE,
39 				       cfg->extracts[i].extract.from_hdr.type);
40 			extr->size = cfg->extracts[i].extract.from_hdr.size;
41 			extr->offset = cfg->extracts[i].extract.from_hdr.offset;
42 			extr->field = cpu_to_le32(
43 				cfg->extracts[i].extract.from_hdr.field);
44 			extr->hdr_index =
45 				cfg->extracts[i].extract.from_hdr.hdr_index;
46 			break;
47 		case DPKG_EXTRACT_FROM_DATA:
48 			extr->size = cfg->extracts[i].extract.from_data.size;
49 			extr->offset =
50 				cfg->extracts[i].extract.from_data.offset;
51 			break;
52 		case DPKG_EXTRACT_FROM_PARSE:
53 			extr->size = cfg->extracts[i].extract.from_parse.size;
54 			extr->offset =
55 				cfg->extracts[i].extract.from_parse.offset;
56 			break;
57 		default:
58 			return -EINVAL;
59 		}
60 
61 		extr->num_of_byte_masks = cfg->extracts[i].num_of_byte_masks;
62 		dpni_set_field(extr->extract_type, EXTRACT_TYPE,
63 			       cfg->extracts[i].type);
64 
65 		for (j = 0; j < DPKG_NUM_OF_MASKS; j++) {
66 			extr->masks[j].mask = cfg->extracts[i].masks[j].mask;
67 			extr->masks[j].offset =
68 				cfg->extracts[i].masks[j].offset;
69 		}
70 	}
71 
72 	return 0;
73 }
74 
75 /**
76  * dpni_open() - Open a control session for the specified object
77  * @mc_io:	Pointer to MC portal's I/O object
78  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
79  * @dpni_id:	DPNI unique ID
80  * @token:	Returned token; use in subsequent API calls
81  *
82  * This function can be used to open a control session for an
83  * already created object; an object may have been declared in
84  * the DPL or by calling the dpni_create() function.
85  * This function returns a unique authentication token,
86  * associated with the specific object ID and the specific MC
87  * portal; this token must be used in all subsequent commands for
88  * this specific object.
89  *
90  * Return:	'0' on Success; Error code otherwise.
91  */
92 int dpni_open(struct fsl_mc_io *mc_io,
93 	      u32 cmd_flags,
94 	      int dpni_id,
95 	      u16 *token)
96 {
97 	struct fsl_mc_command cmd = { 0 };
98 	struct dpni_cmd_open *cmd_params;
99 
100 	int err;
101 
102 	/* prepare command */
103 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_OPEN,
104 					  cmd_flags,
105 					  0);
106 	cmd_params = (struct dpni_cmd_open *)cmd.params;
107 	cmd_params->dpni_id = cpu_to_le32(dpni_id);
108 
109 	/* send command to mc*/
110 	err = mc_send_command(mc_io, &cmd);
111 	if (err)
112 		return err;
113 
114 	/* retrieve response parameters */
115 	*token = mc_cmd_hdr_read_token(&cmd);
116 
117 	return 0;
118 }
119 
120 /**
121  * dpni_close() - Close the control session of the object
122  * @mc_io:	Pointer to MC portal's I/O object
123  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
124  * @token:	Token of DPNI object
125  *
126  * After this function is called, no further operations are
127  * allowed on the object without opening a new control session.
128  *
129  * Return:	'0' on Success; Error code otherwise.
130  */
131 int dpni_close(struct fsl_mc_io *mc_io,
132 	       u32 cmd_flags,
133 	       u16 token)
134 {
135 	struct fsl_mc_command cmd = { 0 };
136 
137 	/* prepare command */
138 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_CLOSE,
139 					  cmd_flags,
140 					  token);
141 
142 	/* send command to mc*/
143 	return mc_send_command(mc_io, &cmd);
144 }
145 
146 /**
147  * dpni_set_pools() - Set buffer pools configuration
148  * @mc_io:	Pointer to MC portal's I/O object
149  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
150  * @token:	Token of DPNI object
151  * @cfg:	Buffer pools configuration
152  *
153  * mandatory for DPNI operation
154  * warning:Allowed only when DPNI is disabled
155  *
156  * Return:	'0' on Success; Error code otherwise.
157  */
158 int dpni_set_pools(struct fsl_mc_io *mc_io,
159 		   u32 cmd_flags,
160 		   u16 token,
161 		   const struct dpni_pools_cfg *cfg)
162 {
163 	struct fsl_mc_command cmd = { 0 };
164 	struct dpni_cmd_set_pools *cmd_params;
165 	int i;
166 
167 	/* prepare command */
168 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_POOLS,
169 					  cmd_flags,
170 					  token);
171 	cmd_params = (struct dpni_cmd_set_pools *)cmd.params;
172 	cmd_params->num_dpbp = cfg->num_dpbp;
173 	for (i = 0; i < DPNI_MAX_DPBP; i++) {
174 		cmd_params->dpbp_id[i] = cpu_to_le32(cfg->pools[i].dpbp_id);
175 		cmd_params->buffer_size[i] =
176 			cpu_to_le16(cfg->pools[i].buffer_size);
177 		cmd_params->backup_pool_mask |=
178 			DPNI_BACKUP_POOL(cfg->pools[i].backup_pool, i);
179 	}
180 
181 	/* send command to mc*/
182 	return mc_send_command(mc_io, &cmd);
183 }
184 
185 /**
186  * dpni_enable() - Enable the DPNI, allow sending and receiving frames.
187  * @mc_io:	Pointer to MC portal's I/O object
188  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
189  * @token:		Token of DPNI object
190  *
191  * Return:	'0' on Success; Error code otherwise.
192  */
193 int dpni_enable(struct fsl_mc_io *mc_io,
194 		u32 cmd_flags,
195 		u16 token)
196 {
197 	struct fsl_mc_command cmd = { 0 };
198 
199 	/* prepare command */
200 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_ENABLE,
201 					  cmd_flags,
202 					  token);
203 
204 	/* send command to mc*/
205 	return mc_send_command(mc_io, &cmd);
206 }
207 
208 /**
209  * dpni_disable() - Disable the DPNI, stop sending and receiving frames.
210  * @mc_io:	Pointer to MC portal's I/O object
211  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
212  * @token:	Token of DPNI object
213  *
214  * Return:	'0' on Success; Error code otherwise.
215  */
216 int dpni_disable(struct fsl_mc_io *mc_io,
217 		 u32 cmd_flags,
218 		 u16 token)
219 {
220 	struct fsl_mc_command cmd = { 0 };
221 
222 	/* prepare command */
223 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_DISABLE,
224 					  cmd_flags,
225 					  token);
226 
227 	/* send command to mc*/
228 	return mc_send_command(mc_io, &cmd);
229 }
230 
231 /**
232  * dpni_is_enabled() - Check if the DPNI is enabled.
233  * @mc_io:	Pointer to MC portal's I/O object
234  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
235  * @token:	Token of DPNI object
236  * @en:		Returns '1' if object is enabled; '0' otherwise
237  *
238  * Return:	'0' on Success; Error code otherwise.
239  */
240 int dpni_is_enabled(struct fsl_mc_io *mc_io,
241 		    u32 cmd_flags,
242 		    u16 token,
243 		    int *en)
244 {
245 	struct fsl_mc_command cmd = { 0 };
246 	struct dpni_rsp_is_enabled *rsp_params;
247 	int err;
248 
249 	/* prepare command */
250 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_IS_ENABLED,
251 					  cmd_flags,
252 					  token);
253 
254 	/* send command to mc*/
255 	err = mc_send_command(mc_io, &cmd);
256 	if (err)
257 		return err;
258 
259 	/* retrieve response parameters */
260 	rsp_params = (struct dpni_rsp_is_enabled *)cmd.params;
261 	*en = dpni_get_field(rsp_params->enabled, ENABLE);
262 
263 	return 0;
264 }
265 
266 /**
267  * dpni_reset() - Reset the DPNI, returns the object to initial state.
268  * @mc_io:	Pointer to MC portal's I/O object
269  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
270  * @token:	Token of DPNI object
271  *
272  * Return:	'0' on Success; Error code otherwise.
273  */
274 int dpni_reset(struct fsl_mc_io *mc_io,
275 	       u32 cmd_flags,
276 	       u16 token)
277 {
278 	struct fsl_mc_command cmd = { 0 };
279 
280 	/* prepare command */
281 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_RESET,
282 					  cmd_flags,
283 					  token);
284 
285 	/* send command to mc*/
286 	return mc_send_command(mc_io, &cmd);
287 }
288 
289 /**
290  * dpni_set_irq_enable() - Set overall interrupt state.
291  * @mc_io:	Pointer to MC portal's I/O object
292  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
293  * @token:	Token of DPNI object
294  * @irq_index:	The interrupt index to configure
295  * @en:		Interrupt state: - enable = 1, disable = 0
296  *
297  * Allows GPP software to control when interrupts are generated.
298  * Each interrupt can have up to 32 causes.  The enable/disable control's the
299  * overall interrupt state. if the interrupt is disabled no causes will cause
300  * an interrupt.
301  *
302  * Return:	'0' on Success; Error code otherwise.
303  */
304 int dpni_set_irq_enable(struct fsl_mc_io *mc_io,
305 			u32 cmd_flags,
306 			u16 token,
307 			u8 irq_index,
308 			u8 en)
309 {
310 	struct fsl_mc_command cmd = { 0 };
311 	struct dpni_cmd_set_irq_enable *cmd_params;
312 
313 	/* prepare command */
314 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_IRQ_ENABLE,
315 					  cmd_flags,
316 					  token);
317 	cmd_params = (struct dpni_cmd_set_irq_enable *)cmd.params;
318 	dpni_set_field(cmd_params->enable, ENABLE, en);
319 	cmd_params->irq_index = irq_index;
320 
321 	/* send command to mc*/
322 	return mc_send_command(mc_io, &cmd);
323 }
324 
325 /**
326  * dpni_get_irq_enable() - Get overall interrupt state
327  * @mc_io:	Pointer to MC portal's I/O object
328  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
329  * @token:	Token of DPNI object
330  * @irq_index:	The interrupt index to configure
331  * @en:		Returned interrupt state - enable = 1, disable = 0
332  *
333  * Return:	'0' on Success; Error code otherwise.
334  */
335 int dpni_get_irq_enable(struct fsl_mc_io *mc_io,
336 			u32 cmd_flags,
337 			u16 token,
338 			u8 irq_index,
339 			u8 *en)
340 {
341 	struct fsl_mc_command cmd = { 0 };
342 	struct dpni_cmd_get_irq_enable *cmd_params;
343 	struct dpni_rsp_get_irq_enable *rsp_params;
344 
345 	int err;
346 
347 	/* prepare command */
348 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_IRQ_ENABLE,
349 					  cmd_flags,
350 					  token);
351 	cmd_params = (struct dpni_cmd_get_irq_enable *)cmd.params;
352 	cmd_params->irq_index = irq_index;
353 
354 	/* send command to mc*/
355 	err = mc_send_command(mc_io, &cmd);
356 	if (err)
357 		return err;
358 
359 	/* retrieve response parameters */
360 	rsp_params = (struct dpni_rsp_get_irq_enable *)cmd.params;
361 	*en = dpni_get_field(rsp_params->enabled, ENABLE);
362 
363 	return 0;
364 }
365 
366 /**
367  * dpni_set_irq_mask() - Set interrupt mask.
368  * @mc_io:	Pointer to MC portal's I/O object
369  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
370  * @token:	Token of DPNI object
371  * @irq_index:	The interrupt index to configure
372  * @mask:	event mask to trigger interrupt;
373  *			each bit:
374  *				0 = ignore event
375  *				1 = consider event for asserting IRQ
376  *
377  * Every interrupt can have up to 32 causes and the interrupt model supports
378  * masking/unmasking each cause independently
379  *
380  * Return:	'0' on Success; Error code otherwise.
381  */
382 int dpni_set_irq_mask(struct fsl_mc_io *mc_io,
383 		      u32 cmd_flags,
384 		      u16 token,
385 		      u8 irq_index,
386 		      u32 mask)
387 {
388 	struct fsl_mc_command cmd = { 0 };
389 	struct dpni_cmd_set_irq_mask *cmd_params;
390 
391 	/* prepare command */
392 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_IRQ_MASK,
393 					  cmd_flags,
394 					  token);
395 	cmd_params = (struct dpni_cmd_set_irq_mask *)cmd.params;
396 	cmd_params->mask = cpu_to_le32(mask);
397 	cmd_params->irq_index = irq_index;
398 
399 	/* send command to mc*/
400 	return mc_send_command(mc_io, &cmd);
401 }
402 
403 /**
404  * dpni_get_irq_mask() - Get interrupt mask.
405  * @mc_io:	Pointer to MC portal's I/O object
406  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
407  * @token:	Token of DPNI object
408  * @irq_index:	The interrupt index to configure
409  * @mask:	Returned event mask to trigger interrupt
410  *
411  * Every interrupt can have up to 32 causes and the interrupt model supports
412  * masking/unmasking each cause independently
413  *
414  * Return:	'0' on Success; Error code otherwise.
415  */
416 int dpni_get_irq_mask(struct fsl_mc_io *mc_io,
417 		      u32 cmd_flags,
418 		      u16 token,
419 		      u8 irq_index,
420 		      u32 *mask)
421 {
422 	struct fsl_mc_command cmd = { 0 };
423 	struct dpni_cmd_get_irq_mask *cmd_params;
424 	struct dpni_rsp_get_irq_mask *rsp_params;
425 	int err;
426 
427 	/* prepare command */
428 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_IRQ_MASK,
429 					  cmd_flags,
430 					  token);
431 	cmd_params = (struct dpni_cmd_get_irq_mask *)cmd.params;
432 	cmd_params->irq_index = irq_index;
433 
434 	/* send command to mc*/
435 	err = mc_send_command(mc_io, &cmd);
436 	if (err)
437 		return err;
438 
439 	/* retrieve response parameters */
440 	rsp_params = (struct dpni_rsp_get_irq_mask *)cmd.params;
441 	*mask = le32_to_cpu(rsp_params->mask);
442 
443 	return 0;
444 }
445 
446 /**
447  * dpni_get_irq_status() - Get the current status of any pending interrupts.
448  * @mc_io:	Pointer to MC portal's I/O object
449  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
450  * @token:	Token of DPNI object
451  * @irq_index:	The interrupt index to configure
452  * @status:	Returned interrupts status - one bit per cause:
453  *			0 = no interrupt pending
454  *			1 = interrupt pending
455  *
456  * Return:	'0' on Success; Error code otherwise.
457  */
458 int dpni_get_irq_status(struct fsl_mc_io *mc_io,
459 			u32 cmd_flags,
460 			u16 token,
461 			u8 irq_index,
462 			u32 *status)
463 {
464 	struct fsl_mc_command cmd = { 0 };
465 	struct dpni_cmd_get_irq_status *cmd_params;
466 	struct dpni_rsp_get_irq_status *rsp_params;
467 	int err;
468 
469 	/* prepare command */
470 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_IRQ_STATUS,
471 					  cmd_flags,
472 					  token);
473 	cmd_params = (struct dpni_cmd_get_irq_status *)cmd.params;
474 	cmd_params->status = cpu_to_le32(*status);
475 	cmd_params->irq_index = irq_index;
476 
477 	/* send command to mc*/
478 	err = mc_send_command(mc_io, &cmd);
479 	if (err)
480 		return err;
481 
482 	/* retrieve response parameters */
483 	rsp_params = (struct dpni_rsp_get_irq_status *)cmd.params;
484 	*status = le32_to_cpu(rsp_params->status);
485 
486 	return 0;
487 }
488 
489 /**
490  * dpni_clear_irq_status() - Clear a pending interrupt's status
491  * @mc_io:	Pointer to MC portal's I/O object
492  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
493  * @token:	Token of DPNI object
494  * @irq_index:	The interrupt index to configure
495  * @status:	bits to clear (W1C) - one bit per cause:
496  *			0 = don't change
497  *			1 = clear status bit
498  *
499  * Return:	'0' on Success; Error code otherwise.
500  */
501 int dpni_clear_irq_status(struct fsl_mc_io *mc_io,
502 			  u32 cmd_flags,
503 			  u16 token,
504 			  u8 irq_index,
505 			  u32 status)
506 {
507 	struct fsl_mc_command cmd = { 0 };
508 	struct dpni_cmd_clear_irq_status *cmd_params;
509 
510 	/* prepare command */
511 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_CLEAR_IRQ_STATUS,
512 					  cmd_flags,
513 					  token);
514 	cmd_params = (struct dpni_cmd_clear_irq_status *)cmd.params;
515 	cmd_params->irq_index = irq_index;
516 	cmd_params->status = cpu_to_le32(status);
517 
518 	/* send command to mc*/
519 	return mc_send_command(mc_io, &cmd);
520 }
521 
522 /**
523  * dpni_get_attributes() - Retrieve DPNI attributes.
524  * @mc_io:	Pointer to MC portal's I/O object
525  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
526  * @token:	Token of DPNI object
527  * @attr:	Object's attributes
528  *
529  * Return:	'0' on Success; Error code otherwise.
530  */
531 int dpni_get_attributes(struct fsl_mc_io *mc_io,
532 			u32 cmd_flags,
533 			u16 token,
534 			struct dpni_attr *attr)
535 {
536 	struct fsl_mc_command cmd = { 0 };
537 	struct dpni_rsp_get_attr *rsp_params;
538 
539 	int err;
540 
541 	/* prepare command */
542 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_ATTR,
543 					  cmd_flags,
544 					  token);
545 
546 	/* send command to mc*/
547 	err = mc_send_command(mc_io, &cmd);
548 	if (err)
549 		return err;
550 
551 	/* retrieve response parameters */
552 	rsp_params = (struct dpni_rsp_get_attr *)cmd.params;
553 	attr->options = le32_to_cpu(rsp_params->options);
554 	attr->num_queues = rsp_params->num_queues;
555 	attr->num_tcs = rsp_params->num_tcs;
556 	attr->mac_filter_entries = rsp_params->mac_filter_entries;
557 	attr->vlan_filter_entries = rsp_params->vlan_filter_entries;
558 	attr->qos_entries = rsp_params->qos_entries;
559 	attr->fs_entries = le16_to_cpu(rsp_params->fs_entries);
560 	attr->qos_key_size = rsp_params->qos_key_size;
561 	attr->fs_key_size = rsp_params->fs_key_size;
562 	attr->wriop_version = le16_to_cpu(rsp_params->wriop_version);
563 
564 	return 0;
565 }
566 
567 /**
568  * dpni_set_errors_behavior() - Set errors behavior
569  * @mc_io:	Pointer to MC portal's I/O object
570  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
571  * @token:	Token of DPNI object
572  * @cfg:	Errors configuration
573  *
574  * this function may be called numerous times with different
575  * error masks
576  *
577  * Return:	'0' on Success; Error code otherwise.
578  */
579 int dpni_set_errors_behavior(struct fsl_mc_io *mc_io,
580 			     u32 cmd_flags,
581 			     u16 token,
582 			     struct dpni_error_cfg *cfg)
583 {
584 	struct fsl_mc_command cmd = { 0 };
585 	struct dpni_cmd_set_errors_behavior *cmd_params;
586 
587 	/* prepare command */
588 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_ERRORS_BEHAVIOR,
589 					  cmd_flags,
590 					  token);
591 	cmd_params = (struct dpni_cmd_set_errors_behavior *)cmd.params;
592 	cmd_params->errors = cpu_to_le32(cfg->errors);
593 	dpni_set_field(cmd_params->flags, ERROR_ACTION, cfg->error_action);
594 	dpni_set_field(cmd_params->flags, FRAME_ANN, cfg->set_frame_annotation);
595 
596 	/* send command to mc*/
597 	return mc_send_command(mc_io, &cmd);
598 }
599 
600 /**
601  * dpni_get_buffer_layout() - Retrieve buffer layout attributes.
602  * @mc_io:	Pointer to MC portal's I/O object
603  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
604  * @token:	Token of DPNI object
605  * @qtype:	Type of queue to retrieve configuration for
606  * @layout:	Returns buffer layout attributes
607  *
608  * Return:	'0' on Success; Error code otherwise.
609  */
610 int dpni_get_buffer_layout(struct fsl_mc_io *mc_io,
611 			   u32 cmd_flags,
612 			   u16 token,
613 			   enum dpni_queue_type qtype,
614 			   struct dpni_buffer_layout *layout)
615 {
616 	struct fsl_mc_command cmd = { 0 };
617 	struct dpni_cmd_get_buffer_layout *cmd_params;
618 	struct dpni_rsp_get_buffer_layout *rsp_params;
619 	int err;
620 
621 	/* prepare command */
622 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_BUFFER_LAYOUT,
623 					  cmd_flags,
624 					  token);
625 	cmd_params = (struct dpni_cmd_get_buffer_layout *)cmd.params;
626 	cmd_params->qtype = qtype;
627 
628 	/* send command to mc*/
629 	err = mc_send_command(mc_io, &cmd);
630 	if (err)
631 		return err;
632 
633 	/* retrieve response parameters */
634 	rsp_params = (struct dpni_rsp_get_buffer_layout *)cmd.params;
635 	layout->pass_timestamp = dpni_get_field(rsp_params->flags, PASS_TS);
636 	layout->pass_parser_result = dpni_get_field(rsp_params->flags, PASS_PR);
637 	layout->pass_frame_status = dpni_get_field(rsp_params->flags, PASS_FS);
638 	layout->private_data_size = le16_to_cpu(rsp_params->private_data_size);
639 	layout->data_align = le16_to_cpu(rsp_params->data_align);
640 	layout->data_head_room = le16_to_cpu(rsp_params->head_room);
641 	layout->data_tail_room = le16_to_cpu(rsp_params->tail_room);
642 
643 	return 0;
644 }
645 
646 /**
647  * dpni_set_buffer_layout() - Set buffer layout configuration.
648  * @mc_io:	Pointer to MC portal's I/O object
649  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
650  * @token:	Token of DPNI object
651  * @qtype:	Type of queue this configuration applies to
652  * @layout:	Buffer layout configuration
653  *
654  * Return:	'0' on Success; Error code otherwise.
655  *
656  * @warning	Allowed only when DPNI is disabled
657  */
658 int dpni_set_buffer_layout(struct fsl_mc_io *mc_io,
659 			   u32 cmd_flags,
660 			   u16 token,
661 			   enum dpni_queue_type qtype,
662 			   const struct dpni_buffer_layout *layout)
663 {
664 	struct fsl_mc_command cmd = { 0 };
665 	struct dpni_cmd_set_buffer_layout *cmd_params;
666 
667 	/* prepare command */
668 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_BUFFER_LAYOUT,
669 					  cmd_flags,
670 					  token);
671 	cmd_params = (struct dpni_cmd_set_buffer_layout *)cmd.params;
672 	cmd_params->qtype = qtype;
673 	cmd_params->options = cpu_to_le16(layout->options);
674 	dpni_set_field(cmd_params->flags, PASS_TS, layout->pass_timestamp);
675 	dpni_set_field(cmd_params->flags, PASS_PR, layout->pass_parser_result);
676 	dpni_set_field(cmd_params->flags, PASS_FS, layout->pass_frame_status);
677 	cmd_params->private_data_size = cpu_to_le16(layout->private_data_size);
678 	cmd_params->data_align = cpu_to_le16(layout->data_align);
679 	cmd_params->head_room = cpu_to_le16(layout->data_head_room);
680 	cmd_params->tail_room = cpu_to_le16(layout->data_tail_room);
681 
682 	/* send command to mc*/
683 	return mc_send_command(mc_io, &cmd);
684 }
685 
686 /**
687  * dpni_set_offload() - Set DPNI offload configuration.
688  * @mc_io:	Pointer to MC portal's I/O object
689  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
690  * @token:	Token of DPNI object
691  * @type:	Type of DPNI offload
692  * @config:	Offload configuration.
693  *		For checksum offloads, non-zero value enables the offload
694  *
695  * Return:     '0' on Success; Error code otherwise.
696  *
697  * @warning    Allowed only when DPNI is disabled
698  */
699 
700 int dpni_set_offload(struct fsl_mc_io *mc_io,
701 		     u32 cmd_flags,
702 		     u16 token,
703 		     enum dpni_offload type,
704 		     u32 config)
705 {
706 	struct fsl_mc_command cmd = { 0 };
707 	struct dpni_cmd_set_offload *cmd_params;
708 
709 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_OFFLOAD,
710 					  cmd_flags,
711 					  token);
712 	cmd_params = (struct dpni_cmd_set_offload *)cmd.params;
713 	cmd_params->dpni_offload = type;
714 	cmd_params->config = cpu_to_le32(config);
715 
716 	return mc_send_command(mc_io, &cmd);
717 }
718 
719 int dpni_get_offload(struct fsl_mc_io *mc_io,
720 		     u32 cmd_flags,
721 		     u16 token,
722 		     enum dpni_offload type,
723 		     u32 *config)
724 {
725 	struct fsl_mc_command cmd = { 0 };
726 	struct dpni_cmd_get_offload *cmd_params;
727 	struct dpni_rsp_get_offload *rsp_params;
728 	int err;
729 
730 	/* prepare command */
731 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_OFFLOAD,
732 					  cmd_flags,
733 					  token);
734 	cmd_params = (struct dpni_cmd_get_offload *)cmd.params;
735 	cmd_params->dpni_offload = type;
736 
737 	/* send command to mc*/
738 	err = mc_send_command(mc_io, &cmd);
739 	if (err)
740 		return err;
741 
742 	/* retrieve response parameters */
743 	rsp_params = (struct dpni_rsp_get_offload *)cmd.params;
744 	*config = le32_to_cpu(rsp_params->config);
745 
746 	return 0;
747 }
748 
749 /**
750  * dpni_get_qdid() - Get the Queuing Destination ID (QDID) that should be used
751  *			for enqueue operations
752  * @mc_io:	Pointer to MC portal's I/O object
753  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
754  * @token:	Token of DPNI object
755  * @qtype:	Type of queue to receive QDID for
756  * @qdid:	Returned virtual QDID value that should be used as an argument
757  *			in all enqueue operations
758  *
759  * Return:	'0' on Success; Error code otherwise.
760  */
761 int dpni_get_qdid(struct fsl_mc_io *mc_io,
762 		  u32 cmd_flags,
763 		  u16 token,
764 		  enum dpni_queue_type qtype,
765 		  u16 *qdid)
766 {
767 	struct fsl_mc_command cmd = { 0 };
768 	struct dpni_cmd_get_qdid *cmd_params;
769 	struct dpni_rsp_get_qdid *rsp_params;
770 	int err;
771 
772 	/* prepare command */
773 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_QDID,
774 					  cmd_flags,
775 					  token);
776 	cmd_params = (struct dpni_cmd_get_qdid *)cmd.params;
777 	cmd_params->qtype = qtype;
778 
779 	/* send command to mc*/
780 	err = mc_send_command(mc_io, &cmd);
781 	if (err)
782 		return err;
783 
784 	/* retrieve response parameters */
785 	rsp_params = (struct dpni_rsp_get_qdid *)cmd.params;
786 	*qdid = le16_to_cpu(rsp_params->qdid);
787 
788 	return 0;
789 }
790 
791 /**
792  * dpni_get_tx_data_offset() - Get the Tx data offset (from start of buffer)
793  * @mc_io:	Pointer to MC portal's I/O object
794  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
795  * @token:	Token of DPNI object
796  * @data_offset: Tx data offset (from start of buffer)
797  *
798  * Return:	'0' on Success; Error code otherwise.
799  */
800 int dpni_get_tx_data_offset(struct fsl_mc_io *mc_io,
801 			    u32 cmd_flags,
802 			    u16 token,
803 			    u16 *data_offset)
804 {
805 	struct fsl_mc_command cmd = { 0 };
806 	struct dpni_rsp_get_tx_data_offset *rsp_params;
807 	int err;
808 
809 	/* prepare command */
810 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_TX_DATA_OFFSET,
811 					  cmd_flags,
812 					  token);
813 
814 	/* send command to mc*/
815 	err = mc_send_command(mc_io, &cmd);
816 	if (err)
817 		return err;
818 
819 	/* retrieve response parameters */
820 	rsp_params = (struct dpni_rsp_get_tx_data_offset *)cmd.params;
821 	*data_offset = le16_to_cpu(rsp_params->data_offset);
822 
823 	return 0;
824 }
825 
826 /**
827  * dpni_set_link_cfg() - set the link configuration.
828  * @mc_io:	Pointer to MC portal's I/O object
829  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
830  * @token:	Token of DPNI object
831  * @cfg:	Link configuration
832  *
833  * Return:	'0' on Success; Error code otherwise.
834  */
835 int dpni_set_link_cfg(struct fsl_mc_io *mc_io,
836 		      u32 cmd_flags,
837 		      u16 token,
838 		      const struct dpni_link_cfg *cfg)
839 {
840 	struct fsl_mc_command cmd = { 0 };
841 	struct dpni_cmd_link_cfg *cmd_params;
842 
843 	/* prepare command */
844 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_LINK_CFG,
845 					  cmd_flags,
846 					  token);
847 	cmd_params = (struct dpni_cmd_link_cfg *)cmd.params;
848 	cmd_params->rate = cpu_to_le32(cfg->rate);
849 	cmd_params->options = cpu_to_le64(cfg->options);
850 
851 	/* send command to mc*/
852 	return mc_send_command(mc_io, &cmd);
853 }
854 
855 /**
856  * dpni_get_link_cfg() - return the link configuration
857  * @mc_io:	Pointer to MC portal's I/O object
858  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
859  * @token:	Token of DPNI object
860  * @cfg:	Link configuration from dpni object
861  *
862  * Return:	'0' on Success; Error code otherwise.
863  */
864 int dpni_get_link_cfg(struct fsl_mc_io *mc_io,
865 		      u32 cmd_flags,
866 		      u16 token,
867 		      struct dpni_link_cfg *cfg)
868 {
869 	struct fsl_mc_command cmd = { 0 };
870 	struct dpni_cmd_link_cfg *rsp_params;
871 	int err;
872 
873 	/* prepare command */
874 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_LINK_CFG,
875 					  cmd_flags,
876 					  token);
877 
878 	/* send command to mc*/
879 	err = mc_send_command(mc_io, &cmd);
880 	if (err)
881 		return err;
882 
883 	/* retrieve response parameters */
884 	rsp_params = (struct dpni_cmd_link_cfg *)cmd.params;
885 	cfg->rate = le32_to_cpu(rsp_params->rate);
886 	cfg->options = le64_to_cpu(rsp_params->options);
887 
888 	return err;
889 }
890 
891 /**
892  * dpni_get_link_state() - Return the link state (either up or down)
893  * @mc_io:	Pointer to MC portal's I/O object
894  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
895  * @token:	Token of DPNI object
896  * @state:	Returned link state;
897  *
898  * Return:	'0' on Success; Error code otherwise.
899  */
900 int dpni_get_link_state(struct fsl_mc_io *mc_io,
901 			u32 cmd_flags,
902 			u16 token,
903 			struct dpni_link_state *state)
904 {
905 	struct fsl_mc_command cmd = { 0 };
906 	struct dpni_rsp_get_link_state *rsp_params;
907 	int err;
908 
909 	/* prepare command */
910 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_LINK_STATE,
911 					  cmd_flags,
912 					  token);
913 
914 	/* send command to mc*/
915 	err = mc_send_command(mc_io, &cmd);
916 	if (err)
917 		return err;
918 
919 	/* retrieve response parameters */
920 	rsp_params = (struct dpni_rsp_get_link_state *)cmd.params;
921 	state->up = dpni_get_field(rsp_params->flags, LINK_STATE);
922 	state->rate = le32_to_cpu(rsp_params->rate);
923 	state->options = le64_to_cpu(rsp_params->options);
924 
925 	return 0;
926 }
927 
928 /**
929  * dpni_set_max_frame_length() - Set the maximum received frame length.
930  * @mc_io:	Pointer to MC portal's I/O object
931  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
932  * @token:	Token of DPNI object
933  * @max_frame_length:	Maximum received frame length (in
934  *				bytes); frame is discarded if its
935  *				length exceeds this value
936  *
937  * Return:	'0' on Success; Error code otherwise.
938  */
939 int dpni_set_max_frame_length(struct fsl_mc_io *mc_io,
940 			      u32 cmd_flags,
941 			      u16 token,
942 			      u16 max_frame_length)
943 {
944 	struct fsl_mc_command cmd = { 0 };
945 	struct dpni_cmd_set_max_frame_length *cmd_params;
946 
947 	/* prepare command */
948 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_MAX_FRAME_LENGTH,
949 					  cmd_flags,
950 					  token);
951 	cmd_params = (struct dpni_cmd_set_max_frame_length *)cmd.params;
952 	cmd_params->max_frame_length = cpu_to_le16(max_frame_length);
953 
954 	/* send command to mc*/
955 	return mc_send_command(mc_io, &cmd);
956 }
957 
958 /**
959  * dpni_get_max_frame_length() - Get the maximum received frame length.
960  * @mc_io:	Pointer to MC portal's I/O object
961  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
962  * @token:	Token of DPNI object
963  * @max_frame_length:	Maximum received frame length (in
964  *				bytes); frame is discarded if its
965  *				length exceeds this value
966  *
967  * Return:	'0' on Success; Error code otherwise.
968  */
969 int dpni_get_max_frame_length(struct fsl_mc_io *mc_io,
970 			      u32 cmd_flags,
971 			      u16 token,
972 			      u16 *max_frame_length)
973 {
974 	struct fsl_mc_command cmd = { 0 };
975 	struct dpni_rsp_get_max_frame_length *rsp_params;
976 	int err;
977 
978 	/* prepare command */
979 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_MAX_FRAME_LENGTH,
980 					  cmd_flags,
981 					  token);
982 
983 	/* send command to mc*/
984 	err = mc_send_command(mc_io, &cmd);
985 	if (err)
986 		return err;
987 
988 	/* retrieve response parameters */
989 	rsp_params = (struct dpni_rsp_get_max_frame_length *)cmd.params;
990 	*max_frame_length = le16_to_cpu(rsp_params->max_frame_length);
991 
992 	return 0;
993 }
994 
995 /**
996  * dpni_set_multicast_promisc() - Enable/disable multicast promiscuous mode
997  * @mc_io:	Pointer to MC portal's I/O object
998  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
999  * @token:	Token of DPNI object
1000  * @en:		Set to '1' to enable; '0' to disable
1001  *
1002  * Return:	'0' on Success; Error code otherwise.
1003  */
1004 int dpni_set_multicast_promisc(struct fsl_mc_io *mc_io,
1005 			       u32 cmd_flags,
1006 			       u16 token,
1007 			       int en)
1008 {
1009 	struct fsl_mc_command cmd = { 0 };
1010 	struct dpni_cmd_set_multicast_promisc *cmd_params;
1011 
1012 	/* prepare command */
1013 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_MCAST_PROMISC,
1014 					  cmd_flags,
1015 					  token);
1016 	cmd_params = (struct dpni_cmd_set_multicast_promisc *)cmd.params;
1017 	dpni_set_field(cmd_params->enable, ENABLE, en);
1018 
1019 	/* send command to mc*/
1020 	return mc_send_command(mc_io, &cmd);
1021 }
1022 
1023 /**
1024  * dpni_get_multicast_promisc() - Get multicast promiscuous mode
1025  * @mc_io:	Pointer to MC portal's I/O object
1026  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1027  * @token:	Token of DPNI object
1028  * @en:		Returns '1' if enabled; '0' otherwise
1029  *
1030  * Return:	'0' on Success; Error code otherwise.
1031  */
1032 int dpni_get_multicast_promisc(struct fsl_mc_io *mc_io,
1033 			       u32 cmd_flags,
1034 			       u16 token,
1035 			       int *en)
1036 {
1037 	struct fsl_mc_command cmd = { 0 };
1038 	struct dpni_rsp_get_multicast_promisc *rsp_params;
1039 	int err;
1040 
1041 	/* prepare command */
1042 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_MCAST_PROMISC,
1043 					  cmd_flags,
1044 					  token);
1045 
1046 	/* send command to mc*/
1047 	err = mc_send_command(mc_io, &cmd);
1048 	if (err)
1049 		return err;
1050 
1051 	/* retrieve response parameters */
1052 	rsp_params = (struct dpni_rsp_get_multicast_promisc *)cmd.params;
1053 	*en = dpni_get_field(rsp_params->enabled, ENABLE);
1054 
1055 	return 0;
1056 }
1057 
1058 /**
1059  * dpni_set_unicast_promisc() - Enable/disable unicast promiscuous mode
1060  * @mc_io:	Pointer to MC portal's I/O object
1061  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1062  * @token:	Token of DPNI object
1063  * @en:		Set to '1' to enable; '0' to disable
1064  *
1065  * Return:	'0' on Success; Error code otherwise.
1066  */
1067 int dpni_set_unicast_promisc(struct fsl_mc_io *mc_io,
1068 			     u32 cmd_flags,
1069 			     u16 token,
1070 			     int en)
1071 {
1072 	struct fsl_mc_command cmd = { 0 };
1073 	struct dpni_cmd_set_unicast_promisc *cmd_params;
1074 
1075 	/* prepare command */
1076 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_UNICAST_PROMISC,
1077 					  cmd_flags,
1078 					  token);
1079 	cmd_params = (struct dpni_cmd_set_unicast_promisc *)cmd.params;
1080 	dpni_set_field(cmd_params->enable, ENABLE, en);
1081 
1082 	/* send command to mc*/
1083 	return mc_send_command(mc_io, &cmd);
1084 }
1085 
1086 /**
1087  * dpni_get_unicast_promisc() - Get unicast promiscuous mode
1088  * @mc_io:	Pointer to MC portal's I/O object
1089  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1090  * @token:	Token of DPNI object
1091  * @en:		Returns '1' if enabled; '0' otherwise
1092  *
1093  * Return:	'0' on Success; Error code otherwise.
1094  */
1095 int dpni_get_unicast_promisc(struct fsl_mc_io *mc_io,
1096 			     u32 cmd_flags,
1097 			     u16 token,
1098 			     int *en)
1099 {
1100 	struct fsl_mc_command cmd = { 0 };
1101 	struct dpni_rsp_get_unicast_promisc *rsp_params;
1102 	int err;
1103 
1104 	/* prepare command */
1105 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_UNICAST_PROMISC,
1106 					  cmd_flags,
1107 					  token);
1108 
1109 	/* send command to mc*/
1110 	err = mc_send_command(mc_io, &cmd);
1111 	if (err)
1112 		return err;
1113 
1114 	/* retrieve response parameters */
1115 	rsp_params = (struct dpni_rsp_get_unicast_promisc *)cmd.params;
1116 	*en = dpni_get_field(rsp_params->enabled, ENABLE);
1117 
1118 	return 0;
1119 }
1120 
1121 /**
1122  * dpni_set_primary_mac_addr() - Set the primary MAC address
1123  * @mc_io:	Pointer to MC portal's I/O object
1124  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1125  * @token:	Token of DPNI object
1126  * @mac_addr:	MAC address to set as primary address
1127  *
1128  * Return:	'0' on Success; Error code otherwise.
1129  */
1130 int dpni_set_primary_mac_addr(struct fsl_mc_io *mc_io,
1131 			      u32 cmd_flags,
1132 			      u16 token,
1133 			      const u8 mac_addr[6])
1134 {
1135 	struct fsl_mc_command cmd = { 0 };
1136 	struct dpni_cmd_set_primary_mac_addr *cmd_params;
1137 	int i;
1138 
1139 	/* prepare command */
1140 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_PRIM_MAC,
1141 					  cmd_flags,
1142 					  token);
1143 	cmd_params = (struct dpni_cmd_set_primary_mac_addr *)cmd.params;
1144 	for (i = 0; i < 6; i++)
1145 		cmd_params->mac_addr[i] = mac_addr[5 - i];
1146 
1147 	/* send command to mc*/
1148 	return mc_send_command(mc_io, &cmd);
1149 }
1150 
1151 /**
1152  * dpni_get_primary_mac_addr() - Get the primary MAC address
1153  * @mc_io:	Pointer to MC portal's I/O object
1154  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1155  * @token:	Token of DPNI object
1156  * @mac_addr:	Returned MAC address
1157  *
1158  * Return:	'0' on Success; Error code otherwise.
1159  */
1160 int dpni_get_primary_mac_addr(struct fsl_mc_io *mc_io,
1161 			      u32 cmd_flags,
1162 			      u16 token,
1163 			      u8 mac_addr[6])
1164 {
1165 	struct fsl_mc_command cmd = { 0 };
1166 	struct dpni_rsp_get_primary_mac_addr *rsp_params;
1167 	int i, err;
1168 
1169 	/* prepare command */
1170 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_PRIM_MAC,
1171 					  cmd_flags,
1172 					  token);
1173 
1174 	/* send command to mc*/
1175 	err = mc_send_command(mc_io, &cmd);
1176 	if (err)
1177 		return err;
1178 
1179 	/* retrieve response parameters */
1180 	rsp_params = (struct dpni_rsp_get_primary_mac_addr *)cmd.params;
1181 	for (i = 0; i < 6; i++)
1182 		mac_addr[5 - i] = rsp_params->mac_addr[i];
1183 
1184 	return 0;
1185 }
1186 
1187 /**
1188  * dpni_get_port_mac_addr() - Retrieve MAC address associated to the physical
1189  *			port the DPNI is attached to
1190  * @mc_io:	Pointer to MC portal's I/O object
1191  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1192  * @token:	Token of DPNI object
1193  * @mac_addr:	MAC address of the physical port, if any, otherwise 0
1194  *
1195  * The primary MAC address is not cleared by this operation.
1196  *
1197  * Return:	'0' on Success; Error code otherwise.
1198  */
1199 int dpni_get_port_mac_addr(struct fsl_mc_io *mc_io,
1200 			   u32 cmd_flags,
1201 			   u16 token,
1202 			   u8 mac_addr[6])
1203 {
1204 	struct fsl_mc_command cmd = { 0 };
1205 	struct dpni_rsp_get_port_mac_addr *rsp_params;
1206 	int i, err;
1207 
1208 	/* prepare command */
1209 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_PORT_MAC_ADDR,
1210 					  cmd_flags,
1211 					  token);
1212 
1213 	/* send command to mc*/
1214 	err = mc_send_command(mc_io, &cmd);
1215 	if (err)
1216 		return err;
1217 
1218 	/* retrieve response parameters */
1219 	rsp_params = (struct dpni_rsp_get_port_mac_addr *)cmd.params;
1220 	for (i = 0; i < 6; i++)
1221 		mac_addr[5 - i] = rsp_params->mac_addr[i];
1222 
1223 	return 0;
1224 }
1225 
1226 /**
1227  * dpni_add_mac_addr() - Add MAC address filter
1228  * @mc_io:	Pointer to MC portal's I/O object
1229  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1230  * @token:	Token of DPNI object
1231  * @mac_addr:	MAC address to add
1232  *
1233  * Return:	'0' on Success; Error code otherwise.
1234  */
1235 int dpni_add_mac_addr(struct fsl_mc_io *mc_io,
1236 		      u32 cmd_flags,
1237 		      u16 token,
1238 		      const u8 mac_addr[6])
1239 {
1240 	struct fsl_mc_command cmd = { 0 };
1241 	struct dpni_cmd_add_mac_addr *cmd_params;
1242 	int i;
1243 
1244 	/* prepare command */
1245 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_ADD_MAC_ADDR,
1246 					  cmd_flags,
1247 					  token);
1248 	cmd_params = (struct dpni_cmd_add_mac_addr *)cmd.params;
1249 	for (i = 0; i < 6; i++)
1250 		cmd_params->mac_addr[i] = mac_addr[5 - i];
1251 
1252 	/* send command to mc*/
1253 	return mc_send_command(mc_io, &cmd);
1254 }
1255 
1256 /**
1257  * dpni_remove_mac_addr() - Remove MAC address filter
1258  * @mc_io:	Pointer to MC portal's I/O object
1259  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1260  * @token:	Token of DPNI object
1261  * @mac_addr:	MAC address to remove
1262  *
1263  * Return:	'0' on Success; Error code otherwise.
1264  */
1265 int dpni_remove_mac_addr(struct fsl_mc_io *mc_io,
1266 			 u32 cmd_flags,
1267 			 u16 token,
1268 			 const u8 mac_addr[6])
1269 {
1270 	struct fsl_mc_command cmd = { 0 };
1271 	struct dpni_cmd_remove_mac_addr *cmd_params;
1272 	int i;
1273 
1274 	/* prepare command */
1275 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_REMOVE_MAC_ADDR,
1276 					  cmd_flags,
1277 					  token);
1278 	cmd_params = (struct dpni_cmd_remove_mac_addr *)cmd.params;
1279 	for (i = 0; i < 6; i++)
1280 		cmd_params->mac_addr[i] = mac_addr[5 - i];
1281 
1282 	/* send command to mc*/
1283 	return mc_send_command(mc_io, &cmd);
1284 }
1285 
1286 /**
1287  * dpni_clear_mac_filters() - Clear all unicast and/or multicast MAC filters
1288  * @mc_io:	Pointer to MC portal's I/O object
1289  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1290  * @token:	Token of DPNI object
1291  * @unicast:	Set to '1' to clear unicast addresses
1292  * @multicast:	Set to '1' to clear multicast addresses
1293  *
1294  * The primary MAC address is not cleared by this operation.
1295  *
1296  * Return:	'0' on Success; Error code otherwise.
1297  */
1298 int dpni_clear_mac_filters(struct fsl_mc_io *mc_io,
1299 			   u32 cmd_flags,
1300 			   u16 token,
1301 			   int unicast,
1302 			   int multicast)
1303 {
1304 	struct fsl_mc_command cmd = { 0 };
1305 	struct dpni_cmd_clear_mac_filters *cmd_params;
1306 
1307 	/* prepare command */
1308 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_CLR_MAC_FILTERS,
1309 					  cmd_flags,
1310 					  token);
1311 	cmd_params = (struct dpni_cmd_clear_mac_filters *)cmd.params;
1312 	dpni_set_field(cmd_params->flags, UNICAST_FILTERS, unicast);
1313 	dpni_set_field(cmd_params->flags, MULTICAST_FILTERS, multicast);
1314 
1315 	/* send command to mc*/
1316 	return mc_send_command(mc_io, &cmd);
1317 }
1318 
1319 /**
1320  * dpni_set_rx_tc_dist() - Set Rx traffic class distribution configuration
1321  * @mc_io:	Pointer to MC portal's I/O object
1322  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1323  * @token:	Token of DPNI object
1324  * @tc_id:	Traffic class selection (0-7)
1325  * @cfg:	Traffic class distribution configuration
1326  *
1327  * warning: if 'dist_mode != DPNI_DIST_MODE_NONE', call dpni_prepare_key_cfg()
1328  *			first to prepare the key_cfg_iova parameter
1329  *
1330  * Return:	'0' on Success; error code otherwise.
1331  */
1332 int dpni_set_rx_tc_dist(struct fsl_mc_io *mc_io,
1333 			u32 cmd_flags,
1334 			u16 token,
1335 			u8 tc_id,
1336 			const struct dpni_rx_tc_dist_cfg *cfg)
1337 {
1338 	struct fsl_mc_command cmd = { 0 };
1339 	struct dpni_cmd_set_rx_tc_dist *cmd_params;
1340 
1341 	/* prepare command */
1342 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_RX_TC_DIST,
1343 					  cmd_flags,
1344 					  token);
1345 	cmd_params = (struct dpni_cmd_set_rx_tc_dist *)cmd.params;
1346 	cmd_params->dist_size = cpu_to_le16(cfg->dist_size);
1347 	cmd_params->tc_id = tc_id;
1348 	dpni_set_field(cmd_params->flags, DIST_MODE, cfg->dist_mode);
1349 	dpni_set_field(cmd_params->flags, MISS_ACTION, cfg->fs_cfg.miss_action);
1350 	cmd_params->default_flow_id = cpu_to_le16(cfg->fs_cfg.default_flow_id);
1351 	cmd_params->key_cfg_iova = cpu_to_le64(cfg->key_cfg_iova);
1352 
1353 	/* send command to mc*/
1354 	return mc_send_command(mc_io, &cmd);
1355 }
1356 
1357 /**
1358  * dpni_set_congestion_notification() - Set traffic class congestion
1359  *					notification configuration
1360  * @mc_io:	Pointer to MC portal's I/O object
1361  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1362  * @token:	Token of DPNI object
1363  * @qtype:	Type of queue - Rx, Tx and Tx confirm types are supported
1364  * @tc_id:	Traffic class selection (0-7)
1365  * @cfg:	Congestion notification configuration
1366  *
1367  * Return:	'0' on Success; error code otherwise.
1368  */
1369 int dpni_set_congestion_notification(
1370 			struct fsl_mc_io *mc_io,
1371 			u32 cmd_flags,
1372 			u16 token,
1373 			enum dpni_queue_type qtype,
1374 			u8 tc_id,
1375 			const struct dpni_congestion_notification_cfg *cfg)
1376 {
1377 	struct dpni_cmd_set_congestion_notification *cmd_params;
1378 	struct fsl_mc_command cmd = { 0 };
1379 
1380 	/* prepare command */
1381 	cmd.header =
1382 		mc_encode_cmd_header(DPNI_CMDID_SET_CONGESTION_NOTIFICATION,
1383 				     cmd_flags,
1384 				     token);
1385 	cmd_params = (struct dpni_cmd_set_congestion_notification *)cmd.params;
1386 	cmd_params->qtype = qtype;
1387 	cmd_params->tc = tc_id;
1388 	cmd_params->dest_id = cpu_to_le32(cfg->dest_cfg.dest_id);
1389 	cmd_params->notification_mode = cpu_to_le16(cfg->notification_mode);
1390 	cmd_params->dest_priority = cfg->dest_cfg.priority;
1391 	dpni_set_field(cmd_params->type_units, DEST_TYPE,
1392 		       cfg->dest_cfg.dest_type);
1393 	dpni_set_field(cmd_params->type_units, CONG_UNITS, cfg->units);
1394 	cmd_params->message_iova = cpu_to_le64(cfg->message_iova);
1395 	cmd_params->message_ctx = cpu_to_le64(cfg->message_ctx);
1396 	cmd_params->threshold_entry = cpu_to_le32(cfg->threshold_entry);
1397 	cmd_params->threshold_exit = cpu_to_le32(cfg->threshold_exit);
1398 
1399 	/* send command to mc*/
1400 	return mc_send_command(mc_io, &cmd);
1401 }
1402 
1403 /**
1404  * dpni_set_queue() - Set queue parameters
1405  * @mc_io:	Pointer to MC portal's I/O object
1406  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1407  * @token:	Token of DPNI object
1408  * @qtype:	Type of queue - all queue types are supported, although
1409  *		the command is ignored for Tx
1410  * @tc:		Traffic class, in range 0 to NUM_TCS - 1
1411  * @index:	Selects the specific queue out of the set allocated for the
1412  *		same TC. Value must be in range 0 to NUM_QUEUES - 1
1413  * @options:	A combination of DPNI_QUEUE_OPT_ values that control what
1414  *		configuration options are set on the queue
1415  * @queue:	Queue structure
1416  *
1417  * Return:	'0' on Success; Error code otherwise.
1418  */
1419 int dpni_set_queue(struct fsl_mc_io *mc_io,
1420 		   u32 cmd_flags,
1421 		   u16 token,
1422 		   enum dpni_queue_type qtype,
1423 		   u8 tc,
1424 		   u8 index,
1425 		   u8 options,
1426 		   const struct dpni_queue *queue)
1427 {
1428 	struct fsl_mc_command cmd = { 0 };
1429 	struct dpni_cmd_set_queue *cmd_params;
1430 
1431 	/* prepare command */
1432 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_QUEUE,
1433 					  cmd_flags,
1434 					  token);
1435 	cmd_params = (struct dpni_cmd_set_queue *)cmd.params;
1436 	cmd_params->qtype = qtype;
1437 	cmd_params->tc = tc;
1438 	cmd_params->index = index;
1439 	cmd_params->options = options;
1440 	cmd_params->dest_id = cpu_to_le32(queue->destination.id);
1441 	cmd_params->dest_prio = queue->destination.priority;
1442 	dpni_set_field(cmd_params->flags, DEST_TYPE, queue->destination.type);
1443 	dpni_set_field(cmd_params->flags, STASH_CTRL, queue->flc.stash_control);
1444 	dpni_set_field(cmd_params->flags, HOLD_ACTIVE,
1445 		       queue->destination.hold_active);
1446 	cmd_params->flc = cpu_to_le64(queue->flc.value);
1447 	cmd_params->user_context = cpu_to_le64(queue->user_context);
1448 
1449 	/* send command to mc */
1450 	return mc_send_command(mc_io, &cmd);
1451 }
1452 
1453 /**
1454  * dpni_get_queue() - Get queue parameters
1455  * @mc_io:	Pointer to MC portal's I/O object
1456  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1457  * @token:	Token of DPNI object
1458  * @qtype:	Type of queue - all queue types are supported
1459  * @tc:		Traffic class, in range 0 to NUM_TCS - 1
1460  * @index:	Selects the specific queue out of the set allocated for the
1461  *		same TC. Value must be in range 0 to NUM_QUEUES - 1
1462  * @queue:	Queue configuration structure
1463  * @qid:	Queue identification
1464  *
1465  * Return:	'0' on Success; Error code otherwise.
1466  */
1467 int dpni_get_queue(struct fsl_mc_io *mc_io,
1468 		   u32 cmd_flags,
1469 		   u16 token,
1470 		   enum dpni_queue_type qtype,
1471 		   u8 tc,
1472 		   u8 index,
1473 		   struct dpni_queue *queue,
1474 		   struct dpni_queue_id *qid)
1475 {
1476 	struct fsl_mc_command cmd = { 0 };
1477 	struct dpni_cmd_get_queue *cmd_params;
1478 	struct dpni_rsp_get_queue *rsp_params;
1479 	int err;
1480 
1481 	/* prepare command */
1482 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_QUEUE,
1483 					  cmd_flags,
1484 					  token);
1485 	cmd_params = (struct dpni_cmd_get_queue *)cmd.params;
1486 	cmd_params->qtype = qtype;
1487 	cmd_params->tc = tc;
1488 	cmd_params->index = index;
1489 
1490 	/* send command to mc */
1491 	err = mc_send_command(mc_io, &cmd);
1492 	if (err)
1493 		return err;
1494 
1495 	/* retrieve response parameters */
1496 	rsp_params = (struct dpni_rsp_get_queue *)cmd.params;
1497 	queue->destination.id = le32_to_cpu(rsp_params->dest_id);
1498 	queue->destination.priority = rsp_params->dest_prio;
1499 	queue->destination.type = dpni_get_field(rsp_params->flags,
1500 						 DEST_TYPE);
1501 	queue->flc.stash_control = dpni_get_field(rsp_params->flags,
1502 						  STASH_CTRL);
1503 	queue->destination.hold_active = dpni_get_field(rsp_params->flags,
1504 							HOLD_ACTIVE);
1505 	queue->flc.value = le64_to_cpu(rsp_params->flc);
1506 	queue->user_context = le64_to_cpu(rsp_params->user_context);
1507 	qid->fqid = le32_to_cpu(rsp_params->fqid);
1508 	qid->qdbin = le16_to_cpu(rsp_params->qdbin);
1509 
1510 	return 0;
1511 }
1512 
1513 /**
1514  * dpni_get_statistics() - Get DPNI statistics
1515  * @mc_io:	Pointer to MC portal's I/O object
1516  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1517  * @token:	Token of DPNI object
1518  * @page:	Selects the statistics page to retrieve, see
1519  *		DPNI_GET_STATISTICS output. Pages are numbered 0 to 6.
1520  * @stat:	Structure containing the statistics
1521  *
1522  * Return:	'0' on Success; Error code otherwise.
1523  */
1524 int dpni_get_statistics(struct fsl_mc_io *mc_io,
1525 			u32 cmd_flags,
1526 			u16 token,
1527 			u8 page,
1528 			union dpni_statistics *stat)
1529 {
1530 	struct fsl_mc_command cmd = { 0 };
1531 	struct dpni_cmd_get_statistics *cmd_params;
1532 	struct dpni_rsp_get_statistics *rsp_params;
1533 	int i, err;
1534 
1535 	/* prepare command */
1536 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_STATISTICS,
1537 					  cmd_flags,
1538 					  token);
1539 	cmd_params = (struct dpni_cmd_get_statistics *)cmd.params;
1540 	cmd_params->page_number = page;
1541 
1542 	/* send command to mc */
1543 	err = mc_send_command(mc_io, &cmd);
1544 	if (err)
1545 		return err;
1546 
1547 	/* retrieve response parameters */
1548 	rsp_params = (struct dpni_rsp_get_statistics *)cmd.params;
1549 	for (i = 0; i < DPNI_STATISTICS_CNT; i++)
1550 		stat->raw.counter[i] = le64_to_cpu(rsp_params->counter[i]);
1551 
1552 	return 0;
1553 }
1554 
1555 /**
1556  * dpni_set_taildrop() - Set taildrop per queue or TC
1557  * @mc_io:	Pointer to MC portal's I/O object
1558  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1559  * @token:	Token of DPNI object
1560  * @cg_point:	Congestion point
1561  * @q_type:	Queue type on which the taildrop is configured.
1562  *		Only Rx queues are supported for now
1563  * @tc:		Traffic class to apply this taildrop to
1564  * @q_index:	Index of the queue if the DPNI supports multiple queues for
1565  *		traffic distribution. Ignored if CONGESTION_POINT is not 0.
1566  * @taildrop:	Taildrop structure
1567  *
1568  * Return:	'0' on Success; Error code otherwise.
1569  */
1570 int dpni_set_taildrop(struct fsl_mc_io *mc_io,
1571 		      u32 cmd_flags,
1572 		      u16 token,
1573 		      enum dpni_congestion_point cg_point,
1574 		      enum dpni_queue_type qtype,
1575 		      u8 tc,
1576 		      u8 index,
1577 		      struct dpni_taildrop *taildrop)
1578 {
1579 	struct fsl_mc_command cmd = { 0 };
1580 	struct dpni_cmd_set_taildrop *cmd_params;
1581 
1582 	/* prepare command */
1583 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_TAILDROP,
1584 					  cmd_flags,
1585 					  token);
1586 	cmd_params = (struct dpni_cmd_set_taildrop *)cmd.params;
1587 	cmd_params->congestion_point = cg_point;
1588 	cmd_params->qtype = qtype;
1589 	cmd_params->tc = tc;
1590 	cmd_params->index = index;
1591 	dpni_set_field(cmd_params->enable, ENABLE, taildrop->enable);
1592 	cmd_params->units = taildrop->units;
1593 	cmd_params->threshold = cpu_to_le32(taildrop->threshold);
1594 
1595 	/* send command to mc */
1596 	return mc_send_command(mc_io, &cmd);
1597 }
1598 
1599 /**
1600  * dpni_get_taildrop() - Get taildrop information
1601  * @mc_io:	Pointer to MC portal's I/O object
1602  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1603  * @token:	Token of DPNI object
1604  * @cg_point:	Congestion point
1605  * @q_type:	Queue type on which the taildrop is configured.
1606  *		Only Rx queues are supported for now
1607  * @tc:		Traffic class to apply this taildrop to
1608  * @q_index:	Index of the queue if the DPNI supports multiple queues for
1609  *		traffic distribution. Ignored if CONGESTION_POINT is not 0.
1610  * @taildrop:	Taildrop structure
1611  *
1612  * Return:	'0' on Success; Error code otherwise.
1613  */
1614 int dpni_get_taildrop(struct fsl_mc_io *mc_io,
1615 		      u32 cmd_flags,
1616 		      u16 token,
1617 		      enum dpni_congestion_point cg_point,
1618 		      enum dpni_queue_type qtype,
1619 		      u8 tc,
1620 		      u8 index,
1621 		      struct dpni_taildrop *taildrop)
1622 {
1623 	struct fsl_mc_command cmd = { 0 };
1624 	struct dpni_cmd_get_taildrop *cmd_params;
1625 	struct dpni_rsp_get_taildrop *rsp_params;
1626 	int err;
1627 
1628 	/* prepare command */
1629 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_TAILDROP,
1630 					  cmd_flags,
1631 					  token);
1632 	cmd_params = (struct dpni_cmd_get_taildrop *)cmd.params;
1633 	cmd_params->congestion_point = cg_point;
1634 	cmd_params->qtype = qtype;
1635 	cmd_params->tc = tc;
1636 	cmd_params->index = index;
1637 
1638 	/* send command to mc */
1639 	err = mc_send_command(mc_io, &cmd);
1640 	if (err)
1641 		return err;
1642 
1643 	/* retrieve response parameters */
1644 	rsp_params = (struct dpni_rsp_get_taildrop *)cmd.params;
1645 	taildrop->enable = dpni_get_field(rsp_params->enable, ENABLE);
1646 	taildrop->units = rsp_params->units;
1647 	taildrop->threshold = le32_to_cpu(rsp_params->threshold);
1648 
1649 	return 0;
1650 }
1651 
1652 /**
1653  * dpni_get_api_version() - Get Data Path Network Interface API version
1654  * @mc_io:	Pointer to MC portal's I/O object
1655  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1656  * @major_ver:	Major version of data path network interface API
1657  * @minor_ver:	Minor version of data path network interface API
1658  *
1659  * Return:	'0' on Success; Error code otherwise.
1660  */
1661 int dpni_get_api_version(struct fsl_mc_io *mc_io,
1662 			 u32 cmd_flags,
1663 			 u16 *major_ver,
1664 			 u16 *minor_ver)
1665 {
1666 	struct dpni_rsp_get_api_version *rsp_params;
1667 	struct fsl_mc_command cmd = { 0 };
1668 	int err;
1669 
1670 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_API_VERSION,
1671 					  cmd_flags, 0);
1672 
1673 	err = mc_send_command(mc_io, &cmd);
1674 	if (err)
1675 		return err;
1676 
1677 	rsp_params = (struct dpni_rsp_get_api_version *)cmd.params;
1678 	*major_ver = le16_to_cpu(rsp_params->major);
1679 	*minor_ver = le16_to_cpu(rsp_params->minor);
1680 
1681 	return 0;
1682 }
1683 
1684 /**
1685  * dpni_set_rx_fs_dist() - Set Rx flow steering distribution
1686  * @mc_io:	Pointer to MC portal's I/O object
1687  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1688  * @token:	Token of DPNI object
1689  * @cfg: Distribution configuration
1690  *
1691  * If the FS is already enabled with a previous call the classification
1692  * key will be changed but all the table rules are kept. If the
1693  * existing rules do not match the key the results will not be
1694  * predictable. It is the user responsibility to keep key integrity.
1695  * If cfg.enable is set to 1 the command will create a flow steering table
1696  * and will classify packets according to this table. The packets that
1697  * miss all the table rules will be classified according to settings
1698  * made in dpni_set_rx_hash_dist()
1699  * If cfg.enable is set to 0 the command will clear flow steering table.
1700  * The packets will be classified according to settings made in
1701  * dpni_set_rx_hash_dist()
1702  */
1703 int dpni_set_rx_fs_dist(struct fsl_mc_io *mc_io,
1704 			u32 cmd_flags,
1705 			u16 token,
1706 			const struct dpni_rx_dist_cfg *cfg)
1707 {
1708 	struct dpni_cmd_set_rx_fs_dist *cmd_params;
1709 	struct fsl_mc_command cmd = { 0 };
1710 
1711 	/* prepare command */
1712 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_RX_FS_DIST,
1713 					  cmd_flags,
1714 					  token);
1715 	cmd_params = (struct dpni_cmd_set_rx_fs_dist *)cmd.params;
1716 	cmd_params->dist_size = cpu_to_le16(cfg->dist_size);
1717 	dpni_set_field(cmd_params->enable, RX_FS_DIST_ENABLE, cfg->enable);
1718 	cmd_params->tc = cfg->tc;
1719 	cmd_params->miss_flow_id = cpu_to_le16(cfg->fs_miss_flow_id);
1720 	cmd_params->key_cfg_iova = cpu_to_le64(cfg->key_cfg_iova);
1721 
1722 	/* send command to mc*/
1723 	return mc_send_command(mc_io, &cmd);
1724 }
1725 
1726 /**
1727  * dpni_set_rx_hash_dist() - Set Rx hash distribution
1728  * @mc_io:	Pointer to MC portal's I/O object
1729  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1730  * @token:	Token of DPNI object
1731  * @cfg: Distribution configuration
1732  * If cfg.enable is set to 1 the packets will be classified using a hash
1733  * function based on the key received in cfg.key_cfg_iova parameter.
1734  * If cfg.enable is set to 0 the packets will be sent to the default queue
1735  */
1736 int dpni_set_rx_hash_dist(struct fsl_mc_io *mc_io,
1737 			  u32 cmd_flags,
1738 			  u16 token,
1739 			  const struct dpni_rx_dist_cfg *cfg)
1740 {
1741 	struct dpni_cmd_set_rx_hash_dist *cmd_params;
1742 	struct fsl_mc_command cmd = { 0 };
1743 
1744 	/* prepare command */
1745 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_RX_HASH_DIST,
1746 					  cmd_flags,
1747 					  token);
1748 	cmd_params = (struct dpni_cmd_set_rx_hash_dist *)cmd.params;
1749 	cmd_params->dist_size = cpu_to_le16(cfg->dist_size);
1750 	dpni_set_field(cmd_params->enable, RX_HASH_DIST_ENABLE, cfg->enable);
1751 	cmd_params->tc = cfg->tc;
1752 	cmd_params->key_cfg_iova = cpu_to_le64(cfg->key_cfg_iova);
1753 
1754 	/* send command to mc*/
1755 	return mc_send_command(mc_io, &cmd);
1756 }
1757 
1758 /**
1759  * dpni_add_fs_entry() - Add Flow Steering entry for a specific traffic class
1760  *			(to select a flow ID)
1761  * @mc_io:	Pointer to MC portal's I/O object
1762  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1763  * @token:	Token of DPNI object
1764  * @tc_id:	Traffic class selection (0-7)
1765  * @index:	Location in the FS table where to insert the entry.
1766  *		Only relevant if MASKING is enabled for FS
1767  *		classification on this DPNI, it is ignored for exact match.
1768  * @cfg:	Flow steering rule to add
1769  * @action:	Action to be taken as result of a classification hit
1770  *
1771  * Return:	'0' on Success; Error code otherwise.
1772  */
1773 int dpni_add_fs_entry(struct fsl_mc_io *mc_io,
1774 		      u32 cmd_flags,
1775 		      u16 token,
1776 		      u8 tc_id,
1777 		      u16 index,
1778 		      const struct dpni_rule_cfg *cfg,
1779 		      const struct dpni_fs_action_cfg *action)
1780 {
1781 	struct dpni_cmd_add_fs_entry *cmd_params;
1782 	struct fsl_mc_command cmd = { 0 };
1783 
1784 	/* prepare command */
1785 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_ADD_FS_ENT,
1786 					  cmd_flags,
1787 					  token);
1788 	cmd_params = (struct dpni_cmd_add_fs_entry *)cmd.params;
1789 	cmd_params->tc_id = tc_id;
1790 	cmd_params->key_size = cfg->key_size;
1791 	cmd_params->index = cpu_to_le16(index);
1792 	cmd_params->key_iova = cpu_to_le64(cfg->key_iova);
1793 	cmd_params->mask_iova = cpu_to_le64(cfg->mask_iova);
1794 	cmd_params->options = cpu_to_le16(action->options);
1795 	cmd_params->flow_id = cpu_to_le16(action->flow_id);
1796 	cmd_params->flc = cpu_to_le64(action->flc);
1797 
1798 	/* send command to mc*/
1799 	return mc_send_command(mc_io, &cmd);
1800 }
1801 
1802 /**
1803  * dpni_remove_fs_entry() - Remove Flow Steering entry from a specific
1804  *			    traffic class
1805  * @mc_io:	Pointer to MC portal's I/O object
1806  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1807  * @token:	Token of DPNI object
1808  * @tc_id:	Traffic class selection (0-7)
1809  * @cfg:	Flow steering rule to remove
1810  *
1811  * Return:	'0' on Success; Error code otherwise.
1812  */
1813 int dpni_remove_fs_entry(struct fsl_mc_io *mc_io,
1814 			 u32 cmd_flags,
1815 			 u16 token,
1816 			 u8 tc_id,
1817 			 const struct dpni_rule_cfg *cfg)
1818 {
1819 	struct dpni_cmd_remove_fs_entry *cmd_params;
1820 	struct fsl_mc_command cmd = { 0 };
1821 
1822 	/* prepare command */
1823 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_REMOVE_FS_ENT,
1824 					  cmd_flags,
1825 					  token);
1826 	cmd_params = (struct dpni_cmd_remove_fs_entry *)cmd.params;
1827 	cmd_params->tc_id = tc_id;
1828 	cmd_params->key_size = cfg->key_size;
1829 	cmd_params->key_iova = cpu_to_le64(cfg->key_iova);
1830 	cmd_params->mask_iova = cpu_to_le64(cfg->mask_iova);
1831 
1832 	/* send command to mc*/
1833 	return mc_send_command(mc_io, &cmd);
1834 }
1835 
1836 /**
1837  * dpni_set_qos_table() - Set QoS mapping table
1838  * @mc_io:	Pointer to MC portal's I/O object
1839  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1840  * @token:	Token of DPNI object
1841  * @cfg:	QoS table configuration
1842  *
1843  * This function and all QoS-related functions require that
1844  *'max_tcs > 1' was set at DPNI creation.
1845  *
1846  * warning: Before calling this function, call dpkg_prepare_key_cfg() to
1847  *			prepare the key_cfg_iova parameter
1848  *
1849  * Return:	'0' on Success; Error code otherwise.
1850  */
1851 int dpni_set_qos_table(struct fsl_mc_io *mc_io,
1852 		       u32 cmd_flags,
1853 		       u16 token,
1854 		       const struct dpni_qos_tbl_cfg *cfg)
1855 {
1856 	struct dpni_cmd_set_qos_table *cmd_params;
1857 	struct fsl_mc_command cmd = { 0 };
1858 
1859 	/* prepare command */
1860 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_QOS_TBL,
1861 					  cmd_flags,
1862 					  token);
1863 	cmd_params = (struct dpni_cmd_set_qos_table *)cmd.params;
1864 	cmd_params->default_tc = cfg->default_tc;
1865 	cmd_params->key_cfg_iova = cpu_to_le64(cfg->key_cfg_iova);
1866 	dpni_set_field(cmd_params->discard_on_miss, DISCARD_ON_MISS,
1867 		       cfg->discard_on_miss);
1868 
1869 	/* send command to mc*/
1870 	return mc_send_command(mc_io, &cmd);
1871 }
1872 
1873 /**
1874  * dpni_add_qos_entry() - Add QoS mapping entry (to select a traffic class)
1875  * @mc_io:	Pointer to MC portal's I/O object
1876  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1877  * @token:	Token of DPNI object
1878  * @cfg:	QoS rule to add
1879  * @tc_id:	Traffic class selection (0-7)
1880  * @index:	Location in the QoS table where to insert the entry.
1881  *		Only relevant if MASKING is enabled for QoS classification on
1882  *		this DPNI, it is ignored for exact match.
1883  *
1884  * Return:	'0' on Success; Error code otherwise.
1885  */
1886 int dpni_add_qos_entry(struct fsl_mc_io *mc_io,
1887 		       u32 cmd_flags,
1888 		       u16 token,
1889 		       const struct dpni_rule_cfg *cfg,
1890 		       u8 tc_id,
1891 		       u16 index)
1892 {
1893 	struct dpni_cmd_add_qos_entry *cmd_params;
1894 	struct fsl_mc_command cmd = { 0 };
1895 
1896 	/* prepare command */
1897 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_ADD_QOS_ENT,
1898 					  cmd_flags,
1899 					  token);
1900 	cmd_params = (struct dpni_cmd_add_qos_entry *)cmd.params;
1901 	cmd_params->tc_id = tc_id;
1902 	cmd_params->key_size = cfg->key_size;
1903 	cmd_params->index = cpu_to_le16(index);
1904 	cmd_params->key_iova = cpu_to_le64(cfg->key_iova);
1905 	cmd_params->mask_iova = cpu_to_le64(cfg->mask_iova);
1906 
1907 	/* send command to mc*/
1908 	return mc_send_command(mc_io, &cmd);
1909 }
1910 
1911 /**
1912  * dpni_remove_qos_entry() - Remove QoS mapping entry
1913  * @mc_io:	Pointer to MC portal's I/O object
1914  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1915  * @token:	Token of DPNI object
1916  * @cfg:	QoS rule to remove
1917  *
1918  * Return:	'0' on Success; Error code otherwise.
1919  */
1920 int dpni_remove_qos_entry(struct fsl_mc_io *mc_io,
1921 			  u32 cmd_flags,
1922 			  u16 token,
1923 			  const struct dpni_rule_cfg *cfg)
1924 {
1925 	struct dpni_cmd_remove_qos_entry *cmd_params;
1926 	struct fsl_mc_command cmd = { 0 };
1927 
1928 	/* prepare command */
1929 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_REMOVE_QOS_ENT,
1930 					  cmd_flags,
1931 					  token);
1932 	cmd_params = (struct dpni_cmd_remove_qos_entry *)cmd.params;
1933 	cmd_params->key_size = cfg->key_size;
1934 	cmd_params->key_iova = cpu_to_le64(cfg->key_iova);
1935 	cmd_params->mask_iova = cpu_to_le64(cfg->mask_iova);
1936 
1937 	/* send command to mc*/
1938 	return mc_send_command(mc_io, &cmd);
1939 }
1940 
1941 /**
1942  * dpni_clear_qos_table() - Clear all QoS mapping entries
1943  * @mc_io:	Pointer to MC portal's I/O object
1944  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
1945  * @token:	Token of DPNI object
1946  *
1947  * Following this function call, all frames are directed to
1948  * the default traffic class (0)
1949  *
1950  * Return:	'0' on Success; Error code otherwise.
1951  */
1952 int dpni_clear_qos_table(struct fsl_mc_io *mc_io,
1953 			 u32 cmd_flags,
1954 			 u16 token)
1955 {
1956 	struct fsl_mc_command cmd = { 0 };
1957 
1958 	/* prepare command */
1959 	cmd.header = mc_encode_cmd_header(DPNI_CMDID_CLR_QOS_TBL,
1960 					  cmd_flags,
1961 					  token);
1962 
1963 	/* send command to mc*/
1964 	return mc_send_command(mc_io, &cmd);
1965 }
1966