2018-05-06 21:58:06 +00:00
|
|
|
// SPDX-License-Identifier: GPL-2.0+
|
2015-03-19 16:20:45 +00:00
|
|
|
/*
|
|
|
|
* Freescale Layerscape MC I/O wrapper
|
|
|
|
*
|
2018-05-09 05:22:17 +00:00
|
|
|
* Copyright 2013-2016 Freescale Semiconductor, Inc.
|
2023-05-31 16:04:32 +00:00
|
|
|
* Copyright 2017, 2023 NXP
|
2015-03-19 16:20:45 +00:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <fsl-mc/fsl_mc_sys.h>
|
|
|
|
#include <fsl-mc/fsl_mc_cmd.h>
|
|
|
|
#include <fsl-mc/fsl_dprc.h>
|
|
|
|
|
2023-05-31 16:04:32 +00:00
|
|
|
/**
|
|
|
|
* dprc_get_container_id - Get container ID associated with a given portal.
|
|
|
|
* @mc_io: Pointer to Mc portal's I/O object
|
|
|
|
* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
|
|
|
|
* @container_id: Requested container id
|
|
|
|
*
|
|
|
|
* Return: '0' on Success; Error code otherwise.
|
|
|
|
*/
|
|
|
|
int dprc_get_container_id(struct fsl_mc_io *mc_io, u32 cmd_flags, int *container_id)
|
2015-03-19 16:20:45 +00:00
|
|
|
{
|
|
|
|
struct mc_command cmd = { 0 };
|
|
|
|
int err;
|
|
|
|
|
|
|
|
/* prepare command */
|
|
|
|
cmd.header = mc_encode_cmd_header(DPRC_CMDID_GET_CONT_ID,
|
2015-07-07 10:10:06 +00:00
|
|
|
cmd_flags,
|
|
|
|
0);
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
/* send command to mc*/
|
|
|
|
err = mc_send_command(mc_io, &cmd);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
/* retrieve response parameters */
|
2023-05-31 16:04:32 +00:00
|
|
|
*container_id = (int)mc_cmd_read_object_id(&cmd);
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-05-31 16:04:32 +00:00
|
|
|
/**
|
|
|
|
* dprc_open() - Open DPRC object for use
|
|
|
|
* @mc_io: Pointer to MC portal's I/O object
|
|
|
|
* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
|
|
|
|
* @container_id: Container ID to open
|
|
|
|
* @token: Returned token of DPRC object
|
|
|
|
*
|
|
|
|
* Return: '0' on Success; Error code otherwise.
|
|
|
|
*
|
|
|
|
* @warning Required before any operation on the object.
|
|
|
|
*/
|
|
|
|
int dprc_open(struct fsl_mc_io *mc_io, u32 cmd_flags, int container_id, u16 *token)
|
2015-03-19 16:20:45 +00:00
|
|
|
{
|
2023-05-31 16:04:32 +00:00
|
|
|
struct dprc_cmd_open *cmd_params;
|
2015-03-19 16:20:45 +00:00
|
|
|
struct mc_command cmd = { 0 };
|
|
|
|
int err;
|
|
|
|
|
|
|
|
/* prepare command */
|
2015-07-07 10:10:06 +00:00
|
|
|
cmd.header = mc_encode_cmd_header(DPRC_CMDID_OPEN, cmd_flags,
|
2015-03-19 16:20:45 +00:00
|
|
|
0);
|
2023-05-31 16:04:32 +00:00
|
|
|
cmd_params = (struct dprc_cmd_open *)cmd.params;
|
|
|
|
cmd_params->container_id = cpu_to_le32(container_id);
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
/* send command to mc*/
|
|
|
|
err = mc_send_command(mc_io, &cmd);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
/* retrieve response parameters */
|
2023-05-31 16:04:32 +00:00
|
|
|
*token = mc_cmd_hdr_read_token(&cmd);
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-05-31 16:04:32 +00:00
|
|
|
/**
|
|
|
|
* dprc_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 DPRC 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 dprc_close(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token)
|
2015-03-19 16:20:45 +00:00
|
|
|
{
|
|
|
|
struct mc_command cmd = { 0 };
|
|
|
|
|
|
|
|
/* prepare command */
|
2015-07-07 10:10:06 +00:00
|
|
|
cmd.header = mc_encode_cmd_header(DPRC_CMDID_CLOSE, cmd_flags,
|
2015-03-19 16:20:45 +00:00
|
|
|
token);
|
|
|
|
|
|
|
|
/* send command to mc*/
|
|
|
|
return mc_send_command(mc_io, &cmd);
|
|
|
|
}
|
|
|
|
|
2023-05-31 16:04:32 +00:00
|
|
|
/**
|
|
|
|
* dprc_create_container() - Create child container
|
|
|
|
* @mc_io: Pointer to MC portal's I/O object
|
|
|
|
* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
|
|
|
|
* @token: Token of DPRC object
|
|
|
|
* @cfg: Child container configuration
|
|
|
|
* @child_container_id: Returned child container ID
|
|
|
|
* @child_portal_offset:Returned child portal offset from MC portal base
|
|
|
|
*
|
|
|
|
* Return: '0' on Success; Error code otherwise.
|
|
|
|
*/
|
|
|
|
int dprc_create_container(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token,
|
|
|
|
struct dprc_cfg *cfg, int *child_container_id,
|
|
|
|
uint64_t *child_portal_offset)
|
2015-11-04 06:55:53 +00:00
|
|
|
{
|
2023-05-31 16:04:32 +00:00
|
|
|
struct dprc_cmd_create_container *cmd_params;
|
|
|
|
struct dprc_rsp_create_container *rsp_params;
|
2015-11-04 06:55:53 +00:00
|
|
|
struct mc_command cmd = { 0 };
|
2023-05-31 16:04:32 +00:00
|
|
|
int err, i;
|
2015-11-04 06:55:53 +00:00
|
|
|
|
|
|
|
/* prepare command */
|
|
|
|
cmd.header = mc_encode_cmd_header(DPRC_CMDID_CREATE_CONT,
|
2023-05-31 16:04:32 +00:00
|
|
|
cmd_flags, token);
|
|
|
|
cmd_params = (struct dprc_cmd_create_container *)cmd.params;
|
|
|
|
cmd_params->options = cpu_to_le32(cfg->options);
|
|
|
|
cmd_params->icid = cpu_to_le32(cfg->icid);
|
|
|
|
cmd_params->portal_id = cpu_to_le32(cfg->portal_id);
|
|
|
|
for (i = 0; i < 16; i++)
|
|
|
|
cmd_params->label[i] = cfg->label[i];
|
2015-11-04 06:55:53 +00:00
|
|
|
|
|
|
|
/* send command to mc*/
|
|
|
|
err = mc_send_command(mc_io, &cmd);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
/* retrieve response parameters */
|
2023-05-31 16:04:32 +00:00
|
|
|
rsp_params = (struct dprc_rsp_create_container *)cmd.params;
|
|
|
|
*child_container_id = le32_to_cpu(rsp_params->child_container_id);
|
|
|
|
*child_portal_offset = le64_to_cpu(rsp_params->child_portal_addr);
|
2015-11-04 06:55:53 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-05-31 16:04:32 +00:00
|
|
|
/**
|
|
|
|
* dprc_destroy_container() - Destroy child container.
|
|
|
|
* @mc_io: Pointer to MC portal's I/O object
|
|
|
|
* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
|
|
|
|
* @token: Token of DPRC object
|
|
|
|
* @child_container_id: ID of the container to destroy
|
|
|
|
*
|
|
|
|
* This function terminates the child container, so following this call the
|
|
|
|
* child container ID becomes invalid.
|
|
|
|
*
|
|
|
|
* Notes:
|
|
|
|
* - All resources and objects of the destroyed container are returned to the
|
|
|
|
* parent container or destroyed if were created be the destroyed container.
|
|
|
|
* - This function destroy all the child containers of the specified
|
|
|
|
* container prior to destroying the container itself.
|
|
|
|
*
|
|
|
|
* warning: Only the parent container is allowed to destroy a child policy
|
|
|
|
* Container 0 can't be destroyed
|
|
|
|
*
|
|
|
|
* Return: '0' on Success; Error code otherwise.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
int dprc_destroy_container(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token,
|
2015-11-04 06:55:53 +00:00
|
|
|
int child_container_id)
|
|
|
|
{
|
2023-05-31 16:04:32 +00:00
|
|
|
struct dprc_cmd_destroy_container *cmd_params;
|
2015-11-04 06:55:53 +00:00
|
|
|
struct mc_command cmd = { 0 };
|
|
|
|
|
|
|
|
/* prepare command */
|
|
|
|
cmd.header = mc_encode_cmd_header(DPRC_CMDID_DESTROY_CONT,
|
2023-05-31 16:04:32 +00:00
|
|
|
cmd_flags, token);
|
|
|
|
cmd_params = (struct dprc_cmd_destroy_container *)cmd.params;
|
|
|
|
cmd_params->child_container_id = cpu_to_le32(child_container_id);
|
2015-11-04 06:55:53 +00:00
|
|
|
|
|
|
|
/* send command to mc*/
|
|
|
|
return mc_send_command(mc_io, &cmd);
|
|
|
|
}
|
|
|
|
|
2023-05-31 16:04:32 +00:00
|
|
|
/**
|
|
|
|
* dprc_connect() - Connect two endpoints to create a network link between them
|
|
|
|
* @mc_io: Pointer to MC portal's I/O object
|
|
|
|
* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
|
|
|
|
* @token: Token of DPRC object
|
|
|
|
* @endpoint1: Endpoint 1 configuration parameters
|
|
|
|
* @endpoint2: Endpoint 2 configuration parameters
|
|
|
|
* @cfg: Connection configuration. The connection configuration
|
|
|
|
* is ignored for connections made to DPMAC objects, where
|
|
|
|
* rate is retrieved from the MAC configuration.
|
|
|
|
*
|
|
|
|
* Return: '0' on Success; Error code otherwise.
|
|
|
|
*/
|
|
|
|
int dprc_connect(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token,
|
2015-03-19 16:20:45 +00:00
|
|
|
const struct dprc_endpoint *endpoint1,
|
2015-07-07 10:10:06 +00:00
|
|
|
const struct dprc_endpoint *endpoint2,
|
|
|
|
const struct dprc_connection_cfg *cfg)
|
2015-03-19 16:20:45 +00:00
|
|
|
{
|
2023-05-31 16:04:32 +00:00
|
|
|
struct dprc_cmd_connect *cmd_params;
|
2015-03-19 16:20:45 +00:00
|
|
|
struct mc_command cmd = { 0 };
|
2023-05-31 16:04:32 +00:00
|
|
|
int i;
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
/* prepare command */
|
|
|
|
cmd.header = mc_encode_cmd_header(DPRC_CMDID_CONNECT,
|
2015-07-07 10:10:06 +00:00
|
|
|
cmd_flags,
|
2015-03-19 16:20:45 +00:00
|
|
|
token);
|
2023-05-31 16:04:32 +00:00
|
|
|
cmd_params = (struct dprc_cmd_connect *)cmd.params;
|
|
|
|
cmd_params->ep1_id = cpu_to_le32(endpoint1->id);
|
|
|
|
cmd_params->ep1_interface_id = cpu_to_le16(endpoint1->if_id);
|
|
|
|
cmd_params->ep2_id = cpu_to_le32(endpoint2->id);
|
|
|
|
cmd_params->ep2_interface_id = cpu_to_le16(endpoint2->if_id);
|
|
|
|
cmd_params->max_rate = cpu_to_le32(cfg->max_rate);
|
|
|
|
cmd_params->committed_rate = cpu_to_le32(cfg->committed_rate);
|
|
|
|
for (i = 0; i < 16; i++) {
|
|
|
|
cmd_params->ep1_type[i] = endpoint1->type[i];
|
|
|
|
cmd_params->ep2_type[i] = endpoint2->type[i];
|
|
|
|
}
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
/* send command to mc*/
|
|
|
|
return mc_send_command(mc_io, &cmd);
|
|
|
|
}
|
|
|
|
|
2023-05-31 16:04:32 +00:00
|
|
|
/**
|
|
|
|
* dprc_disconnect() - Disconnect one endpoint to remove its network connection
|
|
|
|
* @mc_io: Pointer to MC portal's I/O object
|
|
|
|
* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
|
|
|
|
* @token: Token of DPRC object
|
|
|
|
* @endpoint: Endpoint configuration parameters
|
|
|
|
*
|
|
|
|
* Return: '0' on Success; Error code otherwise.
|
|
|
|
*/
|
|
|
|
int dprc_disconnect(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token,
|
2015-03-19 16:20:45 +00:00
|
|
|
const struct dprc_endpoint *endpoint)
|
|
|
|
{
|
2023-05-31 16:04:32 +00:00
|
|
|
struct dprc_cmd_disconnect *cmd_params;
|
2015-03-19 16:20:45 +00:00
|
|
|
struct mc_command cmd = { 0 };
|
2023-05-31 16:04:32 +00:00
|
|
|
int i;
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
/* prepare command */
|
|
|
|
cmd.header = mc_encode_cmd_header(DPRC_CMDID_DISCONNECT,
|
2015-07-07 10:10:06 +00:00
|
|
|
cmd_flags,
|
2015-03-19 16:20:45 +00:00
|
|
|
token);
|
2023-05-31 16:04:32 +00:00
|
|
|
cmd_params = (struct dprc_cmd_disconnect *)cmd.params;
|
|
|
|
cmd_params->id = cpu_to_le32(endpoint->id);
|
|
|
|
cmd_params->interface_id = cpu_to_le32(endpoint->if_id);
|
|
|
|
for (i = 0; i < 16; i++)
|
|
|
|
cmd_params->type[i] = endpoint->type[i];
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
/* send command to mc*/
|
|
|
|
return mc_send_command(mc_io, &cmd);
|
|
|
|
}
|
|
|
|
|
2023-05-31 16:04:32 +00:00
|
|
|
/**
|
|
|
|
* dprc_get_connection() - Get connected endpoint and link status if connection
|
|
|
|
* exists.
|
|
|
|
* @mc_io: Pointer to MC portal's I/O object
|
|
|
|
* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
|
|
|
|
* @token: Token of DPRC object
|
|
|
|
* @endpoint1: Endpoint 1 configuration parameters
|
|
|
|
* @endpoint2: Returned endpoint 2 configuration parameters
|
|
|
|
* @state: Returned link state:
|
|
|
|
* 1 - link is up;
|
|
|
|
* 0 - link is down;
|
|
|
|
* -1 - no connection (endpoint2 information is irrelevant)
|
|
|
|
*
|
|
|
|
* Return: '0' on Success; -ENAVAIL if connection does not exist.
|
|
|
|
*/
|
|
|
|
int dprc_get_connection(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token,
|
2015-07-07 10:10:06 +00:00
|
|
|
const struct dprc_endpoint *endpoint1,
|
2023-05-31 16:04:32 +00:00
|
|
|
struct dprc_endpoint *endpoint2, int *state)
|
2015-03-19 16:20:45 +00:00
|
|
|
{
|
2023-05-31 16:04:32 +00:00
|
|
|
struct dprc_cmd_get_connection *cmd_params;
|
|
|
|
struct dprc_rsp_get_connection *rsp_params;
|
2015-03-19 16:20:45 +00:00
|
|
|
struct mc_command cmd = { 0 };
|
2023-05-31 16:04:32 +00:00
|
|
|
int err, i;
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
/* prepare command */
|
|
|
|
cmd.header = mc_encode_cmd_header(DPRC_CMDID_GET_CONNECTION,
|
2015-07-07 10:10:06 +00:00
|
|
|
cmd_flags,
|
2015-03-19 16:20:45 +00:00
|
|
|
token);
|
2023-05-31 16:04:32 +00:00
|
|
|
cmd_params = (struct dprc_cmd_get_connection *)cmd.params;
|
|
|
|
cmd_params->ep1_id = cpu_to_le32(endpoint1->id);
|
|
|
|
cmd_params->ep1_interface_id = cpu_to_le16(endpoint1->if_id);
|
|
|
|
for (i = 0; i < 16; i++)
|
|
|
|
cmd_params->ep1_type[i] = endpoint1->type[i];
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
/* send command to mc*/
|
|
|
|
err = mc_send_command(mc_io, &cmd);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
/* retrieve response parameters */
|
2023-05-31 16:04:32 +00:00
|
|
|
rsp_params = (struct dprc_rsp_get_connection *)cmd.params;
|
|
|
|
endpoint2->id = le32_to_cpu(rsp_params->ep2_id);
|
|
|
|
endpoint2->if_id = le16_to_cpu(rsp_params->ep2_interface_id);
|
|
|
|
*state = le32_to_cpu(rsp_params->state);
|
|
|
|
for (i = 0; i < 16; i++)
|
|
|
|
endpoint2->type[i] = rsp_params->ep2_type[i];
|
2015-03-19 16:20:45 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
2017-11-15 06:29:31 +00:00
|
|
|
|
2023-05-31 16:04:32 +00:00
|
|
|
/**
|
|
|
|
* dprc_get_api_version - Get Data Path Resource Container 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 Resource Container API
|
|
|
|
* @minor_ver: Minor version of Data Path Resource Container API
|
|
|
|
*
|
|
|
|
* Return: '0' on Success; Error code otherwise.
|
|
|
|
*/
|
|
|
|
int dprc_get_api_version(struct fsl_mc_io *mc_io, u32 cmd_flags,
|
|
|
|
u16 *major_ver, u16 *minor_ver)
|
2017-11-15 06:29:31 +00:00
|
|
|
{
|
|
|
|
struct mc_command cmd = { 0 };
|
|
|
|
int err;
|
|
|
|
|
|
|
|
/* prepare command */
|
|
|
|
cmd.header = mc_encode_cmd_header(DPRC_CMDID_GET_API_VERSION,
|
|
|
|
cmd_flags, 0);
|
|
|
|
|
|
|
|
/* send command to mc */
|
|
|
|
err = mc_send_command(mc_io, &cmd);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
/* retrieve response parameters */
|
|
|
|
mc_cmd_read_api_version(&cmd, major_ver, minor_ver);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|