238 lines
6.6 KiB
C
238 lines
6.6 KiB
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);
|
||
|
|
}
|