// SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
/* Copyright 2013-2016 Freescale Semiconductor Inc.
 * Copyright 2016 NXP
 * Copyright 2020 NXP
 */
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/fsl/mc.h>
#include "dpni.h"
#include "dpni-cmd.h"

/**
 * dpni_prepare_key_cfg() - function prepare extract parameters
 * @cfg: defining a full Key Generation profile (rule)
 * @key_cfg_buf: Zeroed 256 bytes of memory before mapping it to DMA
 *
 * This function has to be called before the following functions:
 *      - dpni_set_rx_tc_dist()
 *      - dpni_set_qos_table()
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_prepare_key_cfg(const struct dpkg_profile_cfg *cfg, u8 *key_cfg_buf)
{
        int i, j;
        struct dpni_ext_set_rx_tc_dist *dpni_ext;
        struct dpni_dist_extract *extr;

        if (cfg->num_extracts > DPKG_MAX_NUM_OF_EXTRACTS)
                return -EINVAL;

        dpni_ext = (struct dpni_ext_set_rx_tc_dist *)key_cfg_buf;
        dpni_ext->num_extracts = cfg->num_extracts;

        for (i = 0; i < cfg->num_extracts; i++) {
                extr = &dpni_ext->extracts[i];

                switch (cfg->extracts[i].type) {
                case DPKG_EXTRACT_FROM_HDR:
                        extr->prot = cfg->extracts[i].extract.from_hdr.prot;
                        dpni_set_field(extr->efh_type, EFH_TYPE,
                                       cfg->extracts[i].extract.from_hdr.type);
                        extr->size = cfg->extracts[i].extract.from_hdr.size;
                        extr->offset = cfg->extracts[i].extract.from_hdr.offset;
                        extr->field = cpu_to_le32(
                                cfg->extracts[i].extract.from_hdr.field);
                        extr->hdr_index =
                                cfg->extracts[i].extract.from_hdr.hdr_index;
                        break;
                case DPKG_EXTRACT_FROM_DATA:
                        extr->size = cfg->extracts[i].extract.from_data.size;
                        extr->offset =
                                cfg->extracts[i].extract.from_data.offset;
                        break;
                case DPKG_EXTRACT_FROM_PARSE:
                        extr->size = cfg->extracts[i].extract.from_parse.size;
                        extr->offset =
                                cfg->extracts[i].extract.from_parse.offset;
                        break;
                default:
                        return -EINVAL;
                }

                extr->num_of_byte_masks = cfg->extracts[i].num_of_byte_masks;
                dpni_set_field(extr->extract_type, EXTRACT_TYPE,
                               cfg->extracts[i].type);

                for (j = 0; j < DPKG_NUM_OF_MASKS; j++) {
                        extr->masks[j].mask = cfg->extracts[i].masks[j].mask;
                        extr->masks[j].offset =
                                cfg->extracts[i].masks[j].offset;
                }
        }

        return 0;
}

/**
 * dpni_open() - Open a control session for the specified object
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @dpni_id:    DPNI unique ID
 * @token:      Returned token; use in subsequent API calls
 *
 * This function can be used to open a control session for an
 * already created object; an object may have been declared in
 * the DPL or by calling the dpni_create() function.
 * This function returns a unique authentication token,
 * associated with the specific object ID and the specific MC
 * portal; this token must be used in all subsequent commands for
 * this specific object.
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_open(struct fsl_mc_io *mc_io,
              u32 cmd_flags,
              int dpni_id,
              u16 *token)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_open *cmd_params;

        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_OPEN,
                                          cmd_flags,
                                          0);
        cmd_params = (struct dpni_cmd_open *)cmd.params;
        cmd_params->dpni_id = cpu_to_le32(dpni_id);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        *token = mc_cmd_hdr_read_token(&cmd);

        return 0;
}

/**
 * dpni_close() - Close the control session of the object
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 *
 * After this function is called, no further operations are
 * allowed on the object without opening a new control session.
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_close(struct fsl_mc_io *mc_io,
               u32 cmd_flags,
               u16 token)
{
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_CLOSE,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_set_pools() - Set buffer pools configuration
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cfg:        Buffer pools configuration
 *
 * mandatory for DPNI operation
 * warning:Allowed only when DPNI is disabled
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_pools(struct fsl_mc_io *mc_io,
                   u32 cmd_flags,
                   u16 token,
                   const struct dpni_pools_cfg *cfg)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_pools *cmd_params;
        int i;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_POOLS,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_pools *)cmd.params;
        cmd_params->num_dpbp = cfg->num_dpbp;
        cmd_params->pool_options = cfg->pool_options;
        for (i = 0; i < DPNI_MAX_DPBP; i++) {
                cmd_params->pool[i].dpbp_id =
                        cpu_to_le16(cfg->pools[i].dpbp_id);
                cmd_params->pool[i].priority_mask =
                        cfg->pools[i].priority_mask;
                cmd_params->buffer_size[i] =
                        cpu_to_le16(cfg->pools[i].buffer_size);
                cmd_params->backup_pool_mask |=
                        DPNI_BACKUP_POOL(cfg->pools[i].backup_pool, i);
        }

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_enable() - Enable the DPNI, allow sending and receiving frames.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:              Token of DPNI object
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_enable(struct fsl_mc_io *mc_io,
                u32 cmd_flags,
                u16 token)
{
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_ENABLE,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_disable() - Disable the DPNI, stop sending and receiving frames.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_disable(struct fsl_mc_io *mc_io,
                 u32 cmd_flags,
                 u16 token)
{
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_DISABLE,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_is_enabled() - Check if the DPNI is enabled.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @en:         Returns '1' if object is enabled; '0' otherwise
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_is_enabled(struct fsl_mc_io *mc_io,
                    u32 cmd_flags,
                    u16 token,
                    int *en)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_rsp_is_enabled *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_IS_ENABLED,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_is_enabled *)cmd.params;
        *en = dpni_get_field(rsp_params->enabled, ENABLE);

        return 0;
}

/**
 * dpni_reset() - Reset the DPNI, returns the object to initial state.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_reset(struct fsl_mc_io *mc_io,
               u32 cmd_flags,
               u16 token)
{
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_RESET,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_set_irq_enable() - Set overall interrupt state.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @irq_index:  The interrupt index to configure
 * @en:         Interrupt state: - enable = 1, disable = 0
 *
 * Allows GPP software to control when interrupts are generated.
 * Each interrupt can have up to 32 causes.  The enable/disable control's the
 * overall interrupt state. if the interrupt is disabled no causes will cause
 * an interrupt.
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_irq_enable(struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        u8 irq_index,
                        u8 en)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_irq_enable *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_IRQ_ENABLE,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_irq_enable *)cmd.params;
        dpni_set_field(cmd_params->enable, ENABLE, en);
        cmd_params->irq_index = irq_index;

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_irq_enable() - Get overall interrupt state
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @irq_index:  The interrupt index to configure
 * @en:         Returned interrupt state - enable = 1, disable = 0
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_irq_enable(struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        u8 irq_index,
                        u8 *en)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_get_irq_enable *cmd_params;
        struct dpni_rsp_get_irq_enable *rsp_params;

        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_IRQ_ENABLE,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_get_irq_enable *)cmd.params;
        cmd_params->irq_index = irq_index;

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_irq_enable *)cmd.params;
        *en = dpni_get_field(rsp_params->enabled, ENABLE);

        return 0;
}

/**
 * dpni_set_irq_mask() - Set interrupt mask.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @irq_index:  The interrupt index to configure
 * @mask:       event mask to trigger interrupt;
 *                      each bit:
 *                              0 = ignore event
 *                              1 = consider event for asserting IRQ
 *
 * Every interrupt can have up to 32 causes and the interrupt model supports
 * masking/unmasking each cause independently
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_irq_mask(struct fsl_mc_io *mc_io,
                      u32 cmd_flags,
                      u16 token,
                      u8 irq_index,
                      u32 mask)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_irq_mask *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_IRQ_MASK,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_irq_mask *)cmd.params;
        cmd_params->mask = cpu_to_le32(mask);
        cmd_params->irq_index = irq_index;

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_irq_mask() - Get interrupt mask.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @irq_index:  The interrupt index to configure
 * @mask:       Returned event mask to trigger interrupt
 *
 * Every interrupt can have up to 32 causes and the interrupt model supports
 * masking/unmasking each cause independently
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_irq_mask(struct fsl_mc_io *mc_io,
                      u32 cmd_flags,
                      u16 token,
                      u8 irq_index,
                      u32 *mask)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_get_irq_mask *cmd_params;
        struct dpni_rsp_get_irq_mask *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_IRQ_MASK,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_get_irq_mask *)cmd.params;
        cmd_params->irq_index = irq_index;

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_irq_mask *)cmd.params;
        *mask = le32_to_cpu(rsp_params->mask);

        return 0;
}

/**
 * dpni_get_irq_status() - Get the current status of any pending interrupts.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @irq_index:  The interrupt index to configure
 * @status:     Returned interrupts status - one bit per cause:
 *                      0 = no interrupt pending
 *                      1 = interrupt pending
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_irq_status(struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        u8 irq_index,
                        u32 *status)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_get_irq_status *cmd_params;
        struct dpni_rsp_get_irq_status *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_IRQ_STATUS,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_get_irq_status *)cmd.params;
        cmd_params->status = cpu_to_le32(*status);
        cmd_params->irq_index = irq_index;

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_irq_status *)cmd.params;
        *status = le32_to_cpu(rsp_params->status);

        return 0;
}

/**
 * dpni_clear_irq_status() - Clear a pending interrupt's status
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @irq_index:  The interrupt index to configure
 * @status:     bits to clear (W1C) - one bit per cause:
 *                      0 = don't change
 *                      1 = clear status bit
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_clear_irq_status(struct fsl_mc_io *mc_io,
                          u32 cmd_flags,
                          u16 token,
                          u8 irq_index,
                          u32 status)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_clear_irq_status *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_CLEAR_IRQ_STATUS,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_clear_irq_status *)cmd.params;
        cmd_params->irq_index = irq_index;
        cmd_params->status = cpu_to_le32(status);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_attributes() - Retrieve DPNI attributes.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @attr:       Object's attributes
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_attributes(struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        struct dpni_attr *attr)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_rsp_get_attr *rsp_params;

        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_ATTR,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_attr *)cmd.params;
        attr->options = le32_to_cpu(rsp_params->options);
        attr->num_queues = rsp_params->num_queues;
        attr->num_tcs = rsp_params->num_tcs;
        attr->mac_filter_entries = rsp_params->mac_filter_entries;
        attr->vlan_filter_entries = rsp_params->vlan_filter_entries;
        attr->qos_entries = rsp_params->qos_entries;
        attr->fs_entries = le16_to_cpu(rsp_params->fs_entries);
        attr->qos_key_size = rsp_params->qos_key_size;
        attr->fs_key_size = rsp_params->fs_key_size;
        attr->wriop_version = le16_to_cpu(rsp_params->wriop_version);

        return 0;
}

/**
 * dpni_set_errors_behavior() - Set errors behavior
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cfg:        Errors configuration
 *
 * this function may be called numerous times with different
 * error masks
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_errors_behavior(struct fsl_mc_io *mc_io,
                             u32 cmd_flags,
                             u16 token,
                             struct dpni_error_cfg *cfg)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_errors_behavior *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_ERRORS_BEHAVIOR,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_errors_behavior *)cmd.params;
        cmd_params->errors = cpu_to_le32(cfg->errors);
        dpni_set_field(cmd_params->flags, ERROR_ACTION, cfg->error_action);
        dpni_set_field(cmd_params->flags, FRAME_ANN, cfg->set_frame_annotation);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_buffer_layout() - Retrieve buffer layout attributes.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @qtype:      Type of queue to retrieve configuration for
 * @layout:     Returns buffer layout attributes
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_buffer_layout(struct fsl_mc_io *mc_io,
                           u32 cmd_flags,
                           u16 token,
                           enum dpni_queue_type qtype,
                           struct dpni_buffer_layout *layout)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_get_buffer_layout *cmd_params;
        struct dpni_rsp_get_buffer_layout *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_BUFFER_LAYOUT,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_get_buffer_layout *)cmd.params;
        cmd_params->qtype = qtype;

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_buffer_layout *)cmd.params;
        layout->pass_timestamp = dpni_get_field(rsp_params->flags, PASS_TS);
        layout->pass_parser_result = dpni_get_field(rsp_params->flags, PASS_PR);
        layout->pass_frame_status = dpni_get_field(rsp_params->flags, PASS_FS);
        layout->private_data_size = le16_to_cpu(rsp_params->private_data_size);
        layout->data_align = le16_to_cpu(rsp_params->data_align);
        layout->data_head_room = le16_to_cpu(rsp_params->head_room);
        layout->data_tail_room = le16_to_cpu(rsp_params->tail_room);

        return 0;
}

/**
 * dpni_set_buffer_layout() - Set buffer layout configuration.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @qtype:      Type of queue this configuration applies to
 * @layout:     Buffer layout configuration
 *
 * Return:      '0' on Success; Error code otherwise.
 *
 * @warning     Allowed only when DPNI is disabled
 */
int dpni_set_buffer_layout(struct fsl_mc_io *mc_io,
                           u32 cmd_flags,
                           u16 token,
                           enum dpni_queue_type qtype,
                           const struct dpni_buffer_layout *layout)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_buffer_layout *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_BUFFER_LAYOUT,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_buffer_layout *)cmd.params;
        cmd_params->qtype = qtype;
        cmd_params->options = cpu_to_le16(layout->options);
        dpni_set_field(cmd_params->flags, PASS_TS, layout->pass_timestamp);
        dpni_set_field(cmd_params->flags, PASS_PR, layout->pass_parser_result);
        dpni_set_field(cmd_params->flags, PASS_FS, layout->pass_frame_status);
        cmd_params->private_data_size = cpu_to_le16(layout->private_data_size);
        cmd_params->data_align = cpu_to_le16(layout->data_align);
        cmd_params->head_room = cpu_to_le16(layout->data_head_room);
        cmd_params->tail_room = cpu_to_le16(layout->data_tail_room);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_set_offload() - Set DPNI offload configuration.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @type:       Type of DPNI offload
 * @config:     Offload configuration.
 *              For checksum offloads, non-zero value enables the offload
 *
 * Return:     '0' on Success; Error code otherwise.
 *
 * @warning    Allowed only when DPNI is disabled
 */

int dpni_set_offload(struct fsl_mc_io *mc_io,
                     u32 cmd_flags,
                     u16 token,
                     enum dpni_offload type,
                     u32 config)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_offload *cmd_params;

        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_OFFLOAD,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_offload *)cmd.params;
        cmd_params->dpni_offload = type;
        cmd_params->config = cpu_to_le32(config);

        return mc_send_command(mc_io, &cmd);
}

int dpni_get_offload(struct fsl_mc_io *mc_io,
                     u32 cmd_flags,
                     u16 token,
                     enum dpni_offload type,
                     u32 *config)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_get_offload *cmd_params;
        struct dpni_rsp_get_offload *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_OFFLOAD,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_get_offload *)cmd.params;
        cmd_params->dpni_offload = type;

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_offload *)cmd.params;
        *config = le32_to_cpu(rsp_params->config);

        return 0;
}

/**
 * dpni_get_qdid() - Get the Queuing Destination ID (QDID) that should be used
 *                      for enqueue operations
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @qtype:      Type of queue to receive QDID for
 * @qdid:       Returned virtual QDID value that should be used as an argument
 *                      in all enqueue operations
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_qdid(struct fsl_mc_io *mc_io,
                  u32 cmd_flags,
                  u16 token,
                  enum dpni_queue_type qtype,
                  u16 *qdid)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_get_qdid *cmd_params;
        struct dpni_rsp_get_qdid *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_QDID,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_get_qdid *)cmd.params;
        cmd_params->qtype = qtype;

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_qdid *)cmd.params;
        *qdid = le16_to_cpu(rsp_params->qdid);

        return 0;
}

/**
 * dpni_get_tx_data_offset() - Get the Tx data offset (from start of buffer)
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @data_offset: Tx data offset (from start of buffer)
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_tx_data_offset(struct fsl_mc_io *mc_io,
                            u32 cmd_flags,
                            u16 token,
                            u16 *data_offset)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_rsp_get_tx_data_offset *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_TX_DATA_OFFSET,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_tx_data_offset *)cmd.params;
        *data_offset = le16_to_cpu(rsp_params->data_offset);

        return 0;
}

/**
 * dpni_set_link_cfg() - set the link configuration.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cfg:        Link configuration
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_link_cfg(struct fsl_mc_io *mc_io,
                      u32 cmd_flags,
                      u16 token,
                      const struct dpni_link_cfg *cfg)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_link_cfg *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_LINK_CFG,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_link_cfg *)cmd.params;
        cmd_params->rate = cpu_to_le32(cfg->rate);
        cmd_params->options = cpu_to_le64(cfg->options);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_link_cfg() - return the link configuration
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cfg:        Link configuration from dpni object
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_link_cfg(struct fsl_mc_io *mc_io,
                      u32 cmd_flags,
                      u16 token,
                      struct dpni_link_cfg *cfg)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_link_cfg *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_LINK_CFG,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_cmd_link_cfg *)cmd.params;
        cfg->rate = le32_to_cpu(rsp_params->rate);
        cfg->options = le64_to_cpu(rsp_params->options);

        return err;
}

/**
 * dpni_get_link_state() - Return the link state (either up or down)
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @state:      Returned link state;
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_link_state(struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        struct dpni_link_state *state)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_rsp_get_link_state *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_LINK_STATE,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_link_state *)cmd.params;
        state->up = dpni_get_field(rsp_params->flags, LINK_STATE);
        state->rate = le32_to_cpu(rsp_params->rate);
        state->options = le64_to_cpu(rsp_params->options);

        return 0;
}

/**
 * dpni_set_max_frame_length() - Set the maximum received frame length.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @max_frame_length:   Maximum received frame length (in
 *                              bytes); frame is discarded if its
 *                              length exceeds this value
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_max_frame_length(struct fsl_mc_io *mc_io,
                              u32 cmd_flags,
                              u16 token,
                              u16 max_frame_length)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_max_frame_length *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_MAX_FRAME_LENGTH,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_max_frame_length *)cmd.params;
        cmd_params->max_frame_length = cpu_to_le16(max_frame_length);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_max_frame_length() - Get the maximum received frame length.
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @max_frame_length:   Maximum received frame length (in
 *                              bytes); frame is discarded if its
 *                              length exceeds this value
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_max_frame_length(struct fsl_mc_io *mc_io,
                              u32 cmd_flags,
                              u16 token,
                              u16 *max_frame_length)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_rsp_get_max_frame_length *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_MAX_FRAME_LENGTH,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_max_frame_length *)cmd.params;
        *max_frame_length = le16_to_cpu(rsp_params->max_frame_length);

        return 0;
}

/**
 * dpni_set_multicast_promisc() - Enable/disable multicast promiscuous mode
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @en:         Set to '1' to enable; '0' to disable
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_multicast_promisc(struct fsl_mc_io *mc_io,
                               u32 cmd_flags,
                               u16 token,
                               int en)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_multicast_promisc *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_MCAST_PROMISC,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_multicast_promisc *)cmd.params;
        dpni_set_field(cmd_params->enable, ENABLE, en);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_multicast_promisc() - Get multicast promiscuous mode
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @en:         Returns '1' if enabled; '0' otherwise
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_multicast_promisc(struct fsl_mc_io *mc_io,
                               u32 cmd_flags,
                               u16 token,
                               int *en)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_rsp_get_multicast_promisc *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_MCAST_PROMISC,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_multicast_promisc *)cmd.params;
        *en = dpni_get_field(rsp_params->enabled, ENABLE);

        return 0;
}

/**
 * dpni_set_unicast_promisc() - Enable/disable unicast promiscuous mode
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @en:         Set to '1' to enable; '0' to disable
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_unicast_promisc(struct fsl_mc_io *mc_io,
                             u32 cmd_flags,
                             u16 token,
                             int en)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_unicast_promisc *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_UNICAST_PROMISC,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_unicast_promisc *)cmd.params;
        dpni_set_field(cmd_params->enable, ENABLE, en);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_unicast_promisc() - Get unicast promiscuous mode
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @en:         Returns '1' if enabled; '0' otherwise
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_unicast_promisc(struct fsl_mc_io *mc_io,
                             u32 cmd_flags,
                             u16 token,
                             int *en)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_rsp_get_unicast_promisc *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_UNICAST_PROMISC,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_unicast_promisc *)cmd.params;
        *en = dpni_get_field(rsp_params->enabled, ENABLE);

        return 0;
}

/**
 * dpni_set_primary_mac_addr() - Set the primary MAC address
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @mac_addr:   MAC address to set as primary address
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_primary_mac_addr(struct fsl_mc_io *mc_io,
                              u32 cmd_flags,
                              u16 token,
                              const u8 mac_addr[6])
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_primary_mac_addr *cmd_params;
        int i;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_PRIM_MAC,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_primary_mac_addr *)cmd.params;
        for (i = 0; i < 6; i++)
                cmd_params->mac_addr[i] = mac_addr[5 - i];

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_primary_mac_addr() - Get the primary MAC address
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @mac_addr:   Returned MAC address
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_primary_mac_addr(struct fsl_mc_io *mc_io,
                              u32 cmd_flags,
                              u16 token,
                              u8 mac_addr[6])
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_rsp_get_primary_mac_addr *rsp_params;
        int i, err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_PRIM_MAC,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_primary_mac_addr *)cmd.params;
        for (i = 0; i < 6; i++)
                mac_addr[5 - i] = rsp_params->mac_addr[i];

        return 0;
}

/**
 * dpni_get_port_mac_addr() - Retrieve MAC address associated to the physical
 *                      port the DPNI is attached to
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @mac_addr:   MAC address of the physical port, if any, otherwise 0
 *
 * The primary MAC address is not cleared by this operation.
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_port_mac_addr(struct fsl_mc_io *mc_io,
                           u32 cmd_flags,
                           u16 token,
                           u8 mac_addr[6])
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_rsp_get_port_mac_addr *rsp_params;
        int i, err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_PORT_MAC_ADDR,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_port_mac_addr *)cmd.params;
        for (i = 0; i < 6; i++)
                mac_addr[5 - i] = rsp_params->mac_addr[i];

        return 0;
}

/**
 * dpni_enable_vlan_filter() - Enable/disable VLAN filtering mode
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @en:         Set to '1' to enable; '0' to disable
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_enable_vlan_filter(struct fsl_mc_io *mc_io,
                            u32 cmd_flags,
                            u16 token,
                            u32 en)
{
        struct dpni_cmd_enable_vlan_filter *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_ENABLE_VLAN_FILTER,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_enable_vlan_filter *)cmd.params;
        dpni_set_field(cmd_params->en, ENABLE, en);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_add_vlan_id() - Add VLAN ID filter
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @vlan_id:    VLAN ID to add
 * @flags:   0 - tc_id and flow_id will be ignored.
 * Pkt with this vlan_id will be passed to the next
 * classification stages
 * DPNI_VLAN_SET_QUEUE_ACTION
 * Pkt with this vlan_id will be forward directly to
 * queue defined by the tc_id and flow_id
 *
 * @tc_id: Traffic class selection (0-7)
 * @flow_id: Selects the specific queue out of the set allocated for the
 *           same as tc_id. Value must be in range 0 to NUM_QUEUES - 1
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_add_vlan_id(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token,
                     u16 vlan_id, u8 flags, u8 tc_id, u8 flow_id)
{
        struct dpni_cmd_vlan_id *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_ADD_VLAN_ID,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_vlan_id *)cmd.params;
        cmd_params->flags = flags;
        cmd_params->tc_id = tc_id;
        cmd_params->flow_id =  flow_id;
        cmd_params->vlan_id = cpu_to_le16(vlan_id);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_remove_vlan_id() - Remove VLAN ID filter
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @vlan_id:    VLAN ID to remove
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_remove_vlan_id(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token,
                        u16 vlan_id)
{
        struct dpni_cmd_vlan_id *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_REMOVE_VLAN_ID,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_vlan_id *)cmd.params;
        cmd_params->vlan_id = cpu_to_le16(vlan_id);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_add_mac_addr() - Add MAC address filter
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @mac_addr:   MAC address to add
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_add_mac_addr(struct fsl_mc_io *mc_io,
                      u32 cmd_flags,
                      u16 token,
                      const u8 mac_addr[6])
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_add_mac_addr *cmd_params;
        int i;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_ADD_MAC_ADDR,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_add_mac_addr *)cmd.params;
        for (i = 0; i < 6; i++)
                cmd_params->mac_addr[i] = mac_addr[5 - i];

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_remove_mac_addr() - Remove MAC address filter
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @mac_addr:   MAC address to remove
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_remove_mac_addr(struct fsl_mc_io *mc_io,
                         u32 cmd_flags,
                         u16 token,
                         const u8 mac_addr[6])
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_remove_mac_addr *cmd_params;
        int i;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_REMOVE_MAC_ADDR,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_remove_mac_addr *)cmd.params;
        for (i = 0; i < 6; i++)
                cmd_params->mac_addr[i] = mac_addr[5 - i];

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_clear_mac_filters() - Clear all unicast and/or multicast MAC filters
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @unicast:    Set to '1' to clear unicast addresses
 * @multicast:  Set to '1' to clear multicast addresses
 *
 * The primary MAC address is not cleared by this operation.
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_clear_mac_filters(struct fsl_mc_io *mc_io,
                           u32 cmd_flags,
                           u16 token,
                           int unicast,
                           int multicast)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_clear_mac_filters *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_CLR_MAC_FILTERS,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_clear_mac_filters *)cmd.params;
        dpni_set_field(cmd_params->flags, UNICAST_FILTERS, unicast);
        dpni_set_field(cmd_params->flags, MULTICAST_FILTERS, multicast);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_set_rx_tc_dist() - Set Rx traffic class distribution configuration
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @tc_id:      Traffic class selection (0-7)
 * @cfg:        Traffic class distribution configuration
 *
 * warning: if 'dist_mode != DPNI_DIST_MODE_NONE', call dpni_prepare_key_cfg()
 *                      first to prepare the key_cfg_iova parameter
 *
 * Return:      '0' on Success; error code otherwise.
 */
int dpni_set_rx_tc_dist(struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        u8 tc_id,
                        const struct dpni_rx_tc_dist_cfg *cfg)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_rx_tc_dist *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_RX_TC_DIST,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_rx_tc_dist *)cmd.params;
        cmd_params->dist_size = cpu_to_le16(cfg->dist_size);
        cmd_params->tc_id = tc_id;
        dpni_set_field(cmd_params->flags, DIST_MODE, cfg->dist_mode);
        dpni_set_field(cmd_params->flags, MISS_ACTION, cfg->fs_cfg.miss_action);
        cmd_params->default_flow_id = cpu_to_le16(cfg->fs_cfg.default_flow_id);
        cmd_params->key_cfg_iova = cpu_to_le64(cfg->key_cfg_iova);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_set_congestion_notification() - Set traffic class congestion
 *                                      notification configuration
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @qtype:      Type of queue - Rx, Tx and Tx confirm types are supported
 * @tc_id:      Traffic class selection (0-7)
 * @cfg:        Congestion notification configuration
 *
 * Return:      '0' on Success; error code otherwise.
 */
int dpni_set_congestion_notification(
                        struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        enum dpni_queue_type qtype,
                        u8 tc_id,
                        const struct dpni_congestion_notification_cfg *cfg)
{
        struct dpni_cmd_set_congestion_notification *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header =
                mc_encode_cmd_header(DPNI_CMDID_SET_CONGESTION_NOTIFICATION,
                                     cmd_flags,
                                     token);
        cmd_params = (struct dpni_cmd_set_congestion_notification *)cmd.params;
        cmd_params->qtype = qtype;
        cmd_params->tc = tc_id;
        cmd_params->dest_id = cpu_to_le32(cfg->dest_cfg.dest_id);
        cmd_params->notification_mode = cpu_to_le16(cfg->notification_mode);
        cmd_params->dest_priority = cfg->dest_cfg.priority;
        dpni_set_field(cmd_params->type_units, DEST_TYPE,
                       cfg->dest_cfg.dest_type);
        dpni_set_field(cmd_params->type_units, CONG_UNITS, cfg->units);
        cmd_params->message_iova = cpu_to_le64(cfg->message_iova);
        cmd_params->message_ctx = cpu_to_le64(cfg->message_ctx);
        cmd_params->threshold_entry = cpu_to_le32(cfg->threshold_entry);
        cmd_params->threshold_exit = cpu_to_le32(cfg->threshold_exit);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_set_queue() - Set queue parameters
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @qtype:      Type of queue - all queue types are supported, although
 *              the command is ignored for Tx
 * @tc:         Traffic class, in range 0 to NUM_TCS - 1
 * @index:      Selects the specific queue out of the set allocated for the
 *              same TC. Value must be in range 0 to NUM_QUEUES - 1
 * @options:    A combination of DPNI_QUEUE_OPT_ values that control what
 *              configuration options are set on the queue
 * @queue:      Queue structure
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_queue(struct fsl_mc_io *mc_io,
                   u32 cmd_flags,
                   u16 token,
                   enum dpni_queue_type qtype,
                   u8 tc,
                   u8 index,
                   u8 options,
                   const struct dpni_queue *queue)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_queue *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_QUEUE,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_queue *)cmd.params;
        cmd_params->qtype = qtype;
        cmd_params->tc = tc;
        cmd_params->index = index;
        cmd_params->options = options;
        cmd_params->dest_id = cpu_to_le32(queue->destination.id);
        cmd_params->dest_prio = queue->destination.priority;
        dpni_set_field(cmd_params->flags, DEST_TYPE, queue->destination.type);
        dpni_set_field(cmd_params->flags, STASH_CTRL, queue->flc.stash_control);
        dpni_set_field(cmd_params->flags, HOLD_ACTIVE,
                       queue->destination.hold_active);
        cmd_params->flc = cpu_to_le64(queue->flc.value);
        cmd_params->user_context = cpu_to_le64(queue->user_context);

        /* send command to mc */
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_queue() - Get queue parameters
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @qtype:      Type of queue - all queue types are supported
 * @tc:         Traffic class, in range 0 to NUM_TCS - 1
 * @index:      Selects the specific queue out of the set allocated for the
 *              same TC. Value must be in range 0 to NUM_QUEUES - 1
 * @queue:      Queue configuration structure
 * @qid:        Queue identification
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_queue(struct fsl_mc_io *mc_io,
                   u32 cmd_flags,
                   u16 token,
                   enum dpni_queue_type qtype,
                   u8 tc,
                   u8 index,
                   struct dpni_queue *queue,
                   struct dpni_queue_id *qid)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_get_queue *cmd_params;
        struct dpni_rsp_get_queue *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_QUEUE,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_get_queue *)cmd.params;
        cmd_params->qtype = qtype;
        cmd_params->tc = tc;
        cmd_params->index = index;

        /* send command to mc */
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_queue *)cmd.params;
        queue->destination.id = le32_to_cpu(rsp_params->dest_id);
        queue->destination.priority = rsp_params->dest_prio;
        queue->destination.type = dpni_get_field(rsp_params->flags,
                                                 DEST_TYPE);
        queue->flc.stash_control = dpni_get_field(rsp_params->flags,
                                                  STASH_CTRL);
        queue->destination.hold_active = dpni_get_field(rsp_params->flags,
                                                        HOLD_ACTIVE);
        queue->flc.value = le64_to_cpu(rsp_params->flc);
        queue->user_context = le64_to_cpu(rsp_params->user_context);
        qid->fqid = le32_to_cpu(rsp_params->fqid);
        qid->qdbin = le16_to_cpu(rsp_params->qdbin);

        return 0;
}

/**
 * dpni_get_statistics() - Get DPNI statistics
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @page:       Selects the statistics page to retrieve, see
 *              DPNI_GET_STATISTICS output. Pages are numbered 0 to 6.
 * @stat:       Structure containing the statistics
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_statistics(struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        u8 page,
                        union dpni_statistics *stat)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_get_statistics *cmd_params;
        struct dpni_rsp_get_statistics *rsp_params;
        int i, err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_STATISTICS,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_get_statistics *)cmd.params;
        cmd_params->page_number = page;

        /* send command to mc */
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_statistics *)cmd.params;
        for (i = 0; i < DPNI_STATISTICS_CNT; i++)
                stat->raw.counter[i] = le64_to_cpu(rsp_params->counter[i]);

        return 0;
}

/**
 * dpni_set_taildrop() - Set taildrop per queue or TC
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cg_point:   Congestion point
 * @qtype:      Queue type on which the taildrop is configured.
 *              Only Rx queues are supported for now
 * @tc:         Traffic class to apply this taildrop to
 * @index:      Index of the queue if the DPNI supports multiple queues for
 *              traffic distribution. Ignored if CONGESTION_POINT is not 0.
 * @taildrop:   Taildrop structure
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_taildrop(struct fsl_mc_io *mc_io,
                      u32 cmd_flags,
                      u16 token,
                      enum dpni_congestion_point cg_point,
                      enum dpni_queue_type qtype,
                      u8 tc,
                      u8 index,
                      struct dpni_taildrop *taildrop)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_set_taildrop *cmd_params;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_TAILDROP,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_taildrop *)cmd.params;
        cmd_params->congestion_point = cg_point;
        cmd_params->qtype = qtype;
        cmd_params->tc = tc;
        cmd_params->index = index;
        dpni_set_field(cmd_params->enable, ENABLE, taildrop->enable);
        cmd_params->units = taildrop->units;
        cmd_params->threshold = cpu_to_le32(taildrop->threshold);

        /* send command to mc */
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_taildrop() - Get taildrop information
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cg_point:   Congestion point
 * @qtype:      Queue type on which the taildrop is configured.
 *              Only Rx queues are supported for now
 * @tc:         Traffic class to apply this taildrop to
 * @index:      Index of the queue if the DPNI supports multiple queues for
 *              traffic distribution. Ignored if CONGESTION_POINT is not 0.
 * @taildrop:   Taildrop structure
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_taildrop(struct fsl_mc_io *mc_io,
                      u32 cmd_flags,
                      u16 token,
                      enum dpni_congestion_point cg_point,
                      enum dpni_queue_type qtype,
                      u8 tc,
                      u8 index,
                      struct dpni_taildrop *taildrop)
{
        struct fsl_mc_command cmd = { 0 };
        struct dpni_cmd_get_taildrop *cmd_params;
        struct dpni_rsp_get_taildrop *rsp_params;
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_TAILDROP,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_get_taildrop *)cmd.params;
        cmd_params->congestion_point = cg_point;
        cmd_params->qtype = qtype;
        cmd_params->tc = tc;
        cmd_params->index = index;

        /* send command to mc */
        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* retrieve response parameters */
        rsp_params = (struct dpni_rsp_get_taildrop *)cmd.params;
        taildrop->enable = dpni_get_field(rsp_params->enable, ENABLE);
        taildrop->units = rsp_params->units;
        taildrop->threshold = le32_to_cpu(rsp_params->threshold);

        return 0;
}

/**
 * dpni_get_api_version() - Get Data Path Network Interface API version
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @major_ver:  Major version of data path network interface API
 * @minor_ver:  Minor version of data path network interface API
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_get_api_version(struct fsl_mc_io *mc_io,
                         u32 cmd_flags,
                         u16 *major_ver,
                         u16 *minor_ver)
{
        struct dpni_rsp_get_api_version *rsp_params;
        struct fsl_mc_command cmd = { 0 };
        int err;

        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_API_VERSION,
                                          cmd_flags, 0);

        err = mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        rsp_params = (struct dpni_rsp_get_api_version *)cmd.params;
        *major_ver = le16_to_cpu(rsp_params->major);
        *minor_ver = le16_to_cpu(rsp_params->minor);

        return 0;
}

/**
 * dpni_set_rx_fs_dist() - Set Rx flow steering distribution
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cfg: Distribution configuration
 *
 * If the FS is already enabled with a previous call the classification
 * key will be changed but all the table rules are kept. If the
 * existing rules do not match the key the results will not be
 * predictable. It is the user responsibility to keep key integrity.
 * If cfg.enable is set to 1 the command will create a flow steering table
 * and will classify packets according to this table. The packets that
 * miss all the table rules will be classified according to settings
 * made in dpni_set_rx_hash_dist()
 * If cfg.enable is set to 0 the command will clear flow steering table.
 * The packets will be classified according to settings made in
 * dpni_set_rx_hash_dist()
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_rx_fs_dist(struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        const struct dpni_rx_dist_cfg *cfg)
{
        struct dpni_cmd_set_rx_fs_dist *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_RX_FS_DIST,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_rx_fs_dist *)cmd.params;
        cmd_params->dist_size = cpu_to_le16(cfg->dist_size);
        dpni_set_field(cmd_params->enable, RX_FS_DIST_ENABLE, cfg->enable);
        cmd_params->tc = cfg->tc;
        cmd_params->miss_flow_id = cpu_to_le16(cfg->fs_miss_flow_id);
        cmd_params->key_cfg_iova = cpu_to_le64(cfg->key_cfg_iova);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_set_rx_hash_dist() - Set Rx hash distribution
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cfg: Distribution configuration
 * If cfg.enable is set to 1 the packets will be classified using a hash
 * function based on the key received in cfg.key_cfg_iova parameter.
 * If cfg.enable is set to 0 the packets will be sent to the default queue
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_rx_hash_dist(struct fsl_mc_io *mc_io,
                          u32 cmd_flags,
                          u16 token,
                          const struct dpni_rx_dist_cfg *cfg)
{
        struct dpni_cmd_set_rx_hash_dist *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_RX_HASH_DIST,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_rx_hash_dist *)cmd.params;
        cmd_params->dist_size = cpu_to_le16(cfg->dist_size);
        dpni_set_field(cmd_params->enable, RX_HASH_DIST_ENABLE, cfg->enable);
        cmd_params->tc = cfg->tc;
        cmd_params->key_cfg_iova = cpu_to_le64(cfg->key_cfg_iova);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_add_fs_entry() - Add Flow Steering entry for a specific traffic class
 *                      (to select a flow ID)
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @tc_id:      Traffic class selection (0-7)
 * @index:      Location in the FS table where to insert the entry.
 *              Only relevant if MASKING is enabled for FS
 *              classification on this DPNI, it is ignored for exact match.
 * @cfg:        Flow steering rule to add
 * @action:     Action to be taken as result of a classification hit
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_add_fs_entry(struct fsl_mc_io *mc_io,
                      u32 cmd_flags,
                      u16 token,
                      u8 tc_id,
                      u16 index,
                      const struct dpni_rule_cfg *cfg,
                      const struct dpni_fs_action_cfg *action)
{
        struct dpni_cmd_add_fs_entry *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_ADD_FS_ENT,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_add_fs_entry *)cmd.params;
        cmd_params->tc_id = tc_id;
        cmd_params->key_size = cfg->key_size;
        cmd_params->index = cpu_to_le16(index);
        cmd_params->key_iova = cpu_to_le64(cfg->key_iova);
        cmd_params->mask_iova = cpu_to_le64(cfg->mask_iova);
        cmd_params->options = cpu_to_le16(action->options);
        cmd_params->flow_id = cpu_to_le16(action->flow_id);
        cmd_params->flc = cpu_to_le64(action->flc);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_remove_fs_entry() - Remove Flow Steering entry from a specific
 *                          traffic class
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @tc_id:      Traffic class selection (0-7)
 * @cfg:        Flow steering rule to remove
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_remove_fs_entry(struct fsl_mc_io *mc_io,
                         u32 cmd_flags,
                         u16 token,
                         u8 tc_id,
                         const struct dpni_rule_cfg *cfg)
{
        struct dpni_cmd_remove_fs_entry *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_REMOVE_FS_ENT,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_remove_fs_entry *)cmd.params;
        cmd_params->tc_id = tc_id;
        cmd_params->key_size = cfg->key_size;
        cmd_params->key_iova = cpu_to_le64(cfg->key_iova);
        cmd_params->mask_iova = cpu_to_le64(cfg->mask_iova);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_set_qos_table() - Set QoS mapping table
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cfg:        QoS table configuration
 *
 * This function and all QoS-related functions require that
 *'max_tcs > 1' was set at DPNI creation.
 *
 * warning: Before calling this function, call dpkg_prepare_key_cfg() to
 *                      prepare the key_cfg_iova parameter
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_qos_table(struct fsl_mc_io *mc_io,
                       u32 cmd_flags,
                       u16 token,
                       const struct dpni_qos_tbl_cfg *cfg)
{
        struct dpni_cmd_set_qos_table *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_QOS_TBL,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_qos_table *)cmd.params;
        cmd_params->default_tc = cfg->default_tc;
        cmd_params->key_cfg_iova = cpu_to_le64(cfg->key_cfg_iova);
        dpni_set_field(cmd_params->discard_on_miss, DISCARD_ON_MISS,
                       cfg->discard_on_miss);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_add_qos_entry() - Add QoS mapping entry (to select a traffic class)
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cfg:        QoS rule to add
 * @tc_id:      Traffic class selection (0-7)
 * @index:      Location in the QoS table where to insert the entry.
 *              Only relevant if MASKING is enabled for QoS classification on
 *              this DPNI, it is ignored for exact match.
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_add_qos_entry(struct fsl_mc_io *mc_io,
                       u32 cmd_flags,
                       u16 token,
                       const struct dpni_rule_cfg *cfg,
                       u8 tc_id,
                       u16 index)
{
        struct dpni_cmd_add_qos_entry *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_ADD_QOS_ENT,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_add_qos_entry *)cmd.params;
        cmd_params->tc_id = tc_id;
        cmd_params->key_size = cfg->key_size;
        cmd_params->index = cpu_to_le16(index);
        cmd_params->key_iova = cpu_to_le64(cfg->key_iova);
        cmd_params->mask_iova = cpu_to_le64(cfg->mask_iova);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_remove_qos_entry() - Remove QoS mapping entry
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @cfg:        QoS rule to remove
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_remove_qos_entry(struct fsl_mc_io *mc_io,
                          u32 cmd_flags,
                          u16 token,
                          const struct dpni_rule_cfg *cfg)
{
        struct dpni_cmd_remove_qos_entry *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_REMOVE_QOS_ENT,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_remove_qos_entry *)cmd.params;
        cmd_params->key_size = cfg->key_size;
        cmd_params->key_iova = cpu_to_le64(cfg->key_iova);
        cmd_params->mask_iova = cpu_to_le64(cfg->mask_iova);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_clear_qos_table() - Clear all QoS mapping entries
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 *
 * Following this function call, all frames are directed to
 * the default traffic class (0)
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_clear_qos_table(struct fsl_mc_io *mc_io,
                         u32 cmd_flags,
                         u16 token)
{
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_CLR_QOS_TBL,
                                          cmd_flags,
                                          token);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_set_tx_shaping() - Set the transmit shaping
 * @mc_io:              Pointer to MC portal's I/O object
 * @cmd_flags:          Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:              Token of DPNI object
 * @tx_cr_shaper:       TX committed rate shaping configuration
 * @tx_er_shaper:       TX excess rate shaping configuration
 * @coupled:            Committed and excess rate shapers are coupled
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpni_set_tx_shaping(struct fsl_mc_io *mc_io,
                        u32 cmd_flags,
                        u16 token,
                        const struct dpni_tx_shaping_cfg *tx_cr_shaper,
                        const struct dpni_tx_shaping_cfg *tx_er_shaper,
                        int coupled)
{
        struct dpni_cmd_set_tx_shaping *cmd_params;
        struct fsl_mc_command cmd = { 0 };

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_TX_SHAPING,
                                          cmd_flags,
                                          token);
        cmd_params = (struct dpni_cmd_set_tx_shaping *)cmd.params;
        cmd_params->tx_cr_max_burst_size = cpu_to_le16(tx_cr_shaper->max_burst_size);
        cmd_params->tx_er_max_burst_size = cpu_to_le16(tx_er_shaper->max_burst_size);
        cmd_params->tx_cr_rate_limit = cpu_to_le32(tx_cr_shaper->rate_limit);
        cmd_params->tx_er_rate_limit = cpu_to_le32(tx_er_shaper->rate_limit);
        dpni_set_field(cmd_params->coupled, COUPLED, coupled);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}

/**
 * dpni_get_single_step_cfg() - return current configuration for
 *                              single step PTP
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @ptp_cfg:    ptp single step configuration
 *
 * Return:      '0' on Success; Error code otherwise.
 *
 */
int dpni_get_single_step_cfg(struct fsl_mc_io *mc_io,
                             u32 cmd_flags,
                             u16 token,
                             struct dpni_single_step_cfg *ptp_cfg)
{
        struct dpni_rsp_single_step_cfg *rsp_params;
        struct fsl_mc_command cmd = { 0 };
        int err;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_SINGLE_STEP_CFG,
                                          cmd_flags, token);
        /* send command to mc*/
        err =  mc_send_command(mc_io, &cmd);
        if (err)
                return err;

        /* read command response */
        rsp_params = (struct dpni_rsp_single_step_cfg *)cmd.params;
        ptp_cfg->offset = le16_to_cpu(rsp_params->offset);
        ptp_cfg->en = dpni_get_field(le16_to_cpu(rsp_params->flags),
                                     PTP_ENABLE) ? 1 : 0;
        ptp_cfg->ch_update = dpni_get_field(le16_to_cpu(rsp_params->flags),
                                            PTP_CH_UPDATE) ? 1 : 0;
        ptp_cfg->peer_delay = le32_to_cpu(rsp_params->peer_delay);
        ptp_cfg->ptp_onestep_reg_base =
                                  le32_to_cpu(rsp_params->ptp_onestep_reg_base);

        return err;
}

/**
 * dpni_set_single_step_cfg() - enable/disable and configure single step PTP
 * @mc_io:      Pointer to MC portal's I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPNI object
 * @ptp_cfg:    ptp single step configuration
 *
 * Return:      '0' on Success; Error code otherwise.
 *
 * The function has effect only when dpni object is connected to a dpmac
 * object. If the dpni is not connected to a dpmac the configuration will
 * be stored inside and applied when connection is made.
 */
int dpni_set_single_step_cfg(struct fsl_mc_io *mc_io,
                             u32 cmd_flags,
                             u16 token,
                             struct dpni_single_step_cfg *ptp_cfg)
{
        struct dpni_cmd_single_step_cfg *cmd_params;
        struct fsl_mc_command cmd = { 0 };
        u16 flags;

        /* prepare command */
        cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_SINGLE_STEP_CFG,
                                          cmd_flags, token);
        cmd_params = (struct dpni_cmd_single_step_cfg *)cmd.params;
        cmd_params->offset = cpu_to_le16(ptp_cfg->offset);
        cmd_params->peer_delay = cpu_to_le32(ptp_cfg->peer_delay);

        flags = le16_to_cpu(cmd_params->flags);
        dpni_set_field(flags, PTP_ENABLE, !!ptp_cfg->en);
        dpni_set_field(flags, PTP_CH_UPDATE, !!ptp_cfg->ch_update);
        cmd_params->flags = cpu_to_le16(flags);

        /* send command to mc*/
        return mc_send_command(mc_io, &cmd);
}