Quelle  dpmac.c   Sprache: C

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

/**
 * dpmac_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_'
 * @dpmac_id: DPMAC 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 dpmac_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 dpmac_open(struct fsl_mc_io *mc_io,
        u32 cmd_flags,
        int dpmac_id,
        u16 *token)
{
 struct dpmac_cmd_open *cmd_params;
 struct fsl_mc_command cmd = { 0 };
 int err;

 /* prepare command */
 cmd.header = mc_encode_cmd_header(DPMAC_CMDID_OPEN,
       cmd_flags,
       0);
 cmd_params = (struct dpmac_cmd_open *)cmd.params;
 cmd_params->dpmac_id = cpu_to_le32(dpmac_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 err;
}

/**
 * dpmac_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 DPMAC 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 dpmac_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(DPMAC_CMDID_CLOSE, cmd_flags,
       token);

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

/**
 * dpmac_get_attributes - Retrieve DPMAC 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 DPMAC object
 * @attr: Returned object's attributes
 *
 * Return: '0' on Success; Error code otherwise.
 */
int dpmac_get_attributes(struct fsl_mc_io *mc_io,
    u32 cmd_flags,
    u16 token,
    struct dpmac_attr *attr)
{
 struct dpmac_rsp_get_attributes *rsp_params;
 struct fsl_mc_command cmd = { 0 };
 int err;

 /* prepare command */
 cmd.header = mc_encode_cmd_header(DPMAC_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 dpmac_rsp_get_attributes *)cmd.params;
 attr->eth_if = rsp_params->eth_if;
 attr->link_type = rsp_params->link_type;
 attr->id = le16_to_cpu(rsp_params->id);
 attr->max_rate = le32_to_cpu(rsp_params->max_rate);

 return 0;
}

/**
 * dpmac_set_link_state() - Set the Ethernet link status
 * @mc_io:      Pointer to opaque I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPMAC object
 * @link_state: Link state configuration
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpmac_set_link_state(struct fsl_mc_io *mc_io,
    u32 cmd_flags,
    u16 token,
    struct dpmac_link_state *link_state)
{
 struct dpmac_cmd_set_link_state *cmd_params;
 struct fsl_mc_command cmd = { 0 };

 /* prepare command */
 cmd.header = mc_encode_cmd_header(DPMAC_CMDID_SET_LINK_STATE,
       cmd_flags,
       token);
 cmd_params = (struct dpmac_cmd_set_link_state *)cmd.params;
 cmd_params->options = cpu_to_le64(link_state->options);
 cmd_params->rate = cpu_to_le32(link_state->rate);
 dpmac_set_field(cmd_params->state, STATE, link_state->up);
 dpmac_set_field(cmd_params->state, STATE_VALID,
   link_state->state_valid);
 cmd_params->supported = cpu_to_le64(link_state->supported);
 cmd_params->advertising = cpu_to_le64(link_state->advertising);

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

/**
 * dpmac_get_counter() - Read a specific DPMAC counter
 * @mc_io: Pointer to opaque I/O object
 * @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
 * @token: Token of DPMAC object
 * @id: The requested counter ID
 * @value: Returned counter value
 *
 * Return: The requested counter; '0' otherwise.
 */
int dpmac_get_counter(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token,
        enum dpmac_counter_id id, u64 *value)
{
 struct dpmac_cmd_get_counter *dpmac_cmd;
 struct dpmac_rsp_get_counter *dpmac_rsp;
 struct fsl_mc_command cmd = { 0 };
 int err = 0;

 cmd.header = mc_encode_cmd_header(DPMAC_CMDID_GET_COUNTER,
       cmd_flags,
       token);
 dpmac_cmd = (struct dpmac_cmd_get_counter *)cmd.params;
 dpmac_cmd->id = id;

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

 dpmac_rsp = (struct dpmac_rsp_get_counter *)cmd.params;
 *value = le64_to_cpu(dpmac_rsp->counter);

 return 0;
}

/**
 * dpmac_get_api_version() - Get Data Path MAC 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 mac API
 * @minor_ver: Minor version of data path mac API
 *
 * Return:  '0' on Success; Error code otherwise.
 */
int dpmac_get_api_version(struct fsl_mc_io *mc_io, u32 cmd_flags,
     u16 *major_ver, u16 *minor_ver)
{
 struct dpmac_rsp_get_api_version *rsp_params;
 struct fsl_mc_command cmd = { 0 };
 int err;

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

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

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

 return 0;
}

/**
 * dpmac_set_protocol() - Reconfigure the DPMAC protocol
 * @mc_io:      Pointer to opaque I/O object
 * @cmd_flags:  Command flags; one or more of 'MC_CMD_FLAG_'
 * @token:      Token of DPMAC object
 * @protocol:   New protocol for the DPMAC to be reconfigured in.
 *
 * Return:      '0' on Success; Error code otherwise.
 */
int dpmac_set_protocol(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token,
         enum dpmac_eth_if protocol)
{
 struct dpmac_cmd_set_protocol *cmd_params;
 struct fsl_mc_command cmd = { 0 };

 cmd.header = mc_encode_cmd_header(DPMAC_CMDID_SET_PROTOCOL,
       cmd_flags, token);
 cmd_params = (struct dpmac_cmd_set_protocol *)cmd.params;
 cmd_params->eth_if = protocol;

 return mc_send_command(mc_io, &cmd);
}