| // SPDX-License-Identifier: GPL-2.0+ | |
| /* | |
| * Freescale Layerscape MC I/O wrapper | |
| * | |
| * Copyright 2013-2016 Freescale Semiconductor, Inc. | |
| * Copyright 2017, 2023 NXP | |
| */ | |
| #include <fsl-mc/fsl_mc_sys.h> | |
| #include <fsl-mc/fsl_mc_cmd.h> | |
| #include <fsl-mc/fsl_dprc.h> | |
| /** | |
| * 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) | |
| { | |
| struct mc_command cmd = { 0 }; | |
| int err; | |
| /* prepare command */ | |
| cmd.header = mc_encode_cmd_header(DPRC_CMDID_GET_CONT_ID, | |
| cmd_flags, | |
| 0); | |
| /* send command to mc*/ | |
| err = mc_send_command(mc_io, &cmd); | |
| if (err) | |
| return err; | |
| /* retrieve response parameters */ | |
| *container_id = (int)mc_cmd_read_object_id(&cmd); | |
| return 0; | |
| } | |
| /** | |
| * 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) | |
| { | |
| struct dprc_cmd_open *cmd_params; | |
| struct mc_command cmd = { 0 }; | |
| int err; | |
| /* prepare command */ | |
| cmd.header = mc_encode_cmd_header(DPRC_CMDID_OPEN, cmd_flags, | |
| 0); | |
| cmd_params = (struct dprc_cmd_open *)cmd.params; | |
| cmd_params->container_id = cpu_to_le32(container_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; | |
| } | |
| /** | |
| * 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) | |
| { | |
| struct mc_command cmd = { 0 }; | |
| /* prepare command */ | |
| cmd.header = mc_encode_cmd_header(DPRC_CMDID_CLOSE, cmd_flags, | |
| token); | |
| /* send command to mc*/ | |
| return mc_send_command(mc_io, &cmd); | |
| } | |
| /** | |
| * 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) | |
| { | |
| struct dprc_cmd_create_container *cmd_params; | |
| struct dprc_rsp_create_container *rsp_params; | |
| struct mc_command cmd = { 0 }; | |
| int err, i; | |
| /* prepare command */ | |
| cmd.header = mc_encode_cmd_header(DPRC_CMDID_CREATE_CONT, | |
| 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]; | |
| /* send command to mc*/ | |
| err = mc_send_command(mc_io, &cmd); | |
| if (err) | |
| return err; | |
| /* retrieve response parameters */ | |
| 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); | |
| return 0; | |
| } | |
| /** | |
| * 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, | |
| int child_container_id) | |
| { | |
| struct dprc_cmd_destroy_container *cmd_params; | |
| struct mc_command cmd = { 0 }; | |
| /* prepare command */ | |
| cmd.header = mc_encode_cmd_header(DPRC_CMDID_DESTROY_CONT, | |
| cmd_flags, token); | |
| cmd_params = (struct dprc_cmd_destroy_container *)cmd.params; | |
| cmd_params->child_container_id = cpu_to_le32(child_container_id); | |
| /* send command to mc*/ | |
| return mc_send_command(mc_io, &cmd); | |
| } | |
| /** | |
| * 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, | |
| const struct dprc_endpoint *endpoint1, | |
| const struct dprc_endpoint *endpoint2, | |
| const struct dprc_connection_cfg *cfg) | |
| { | |
| struct dprc_cmd_connect *cmd_params; | |
| struct mc_command cmd = { 0 }; | |
| int i; | |
| /* prepare command */ | |
| cmd.header = mc_encode_cmd_header(DPRC_CMDID_CONNECT, | |
| cmd_flags, | |
| token); | |
| 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]; | |
| } | |
| /* send command to mc*/ | |
| return mc_send_command(mc_io, &cmd); | |
| } | |
| /** | |
| * 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, | |
| const struct dprc_endpoint *endpoint) | |
| { | |
| struct dprc_cmd_disconnect *cmd_params; | |
| struct mc_command cmd = { 0 }; | |
| int i; | |
| /* prepare command */ | |
| cmd.header = mc_encode_cmd_header(DPRC_CMDID_DISCONNECT, | |
| cmd_flags, | |
| token); | |
| 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]; | |
| /* send command to mc*/ | |
| return mc_send_command(mc_io, &cmd); | |
| } | |
| /** | |
| * 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, | |
| const struct dprc_endpoint *endpoint1, | |
| struct dprc_endpoint *endpoint2, int *state) | |
| { | |
| struct dprc_cmd_get_connection *cmd_params; | |
| struct dprc_rsp_get_connection *rsp_params; | |
| struct mc_command cmd = { 0 }; | |
| int err, i; | |
| /* prepare command */ | |
| cmd.header = mc_encode_cmd_header(DPRC_CMDID_GET_CONNECTION, | |
| cmd_flags, | |
| token); | |
| 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]; | |
| /* send command to mc*/ | |
| err = mc_send_command(mc_io, &cmd); | |
| if (err) | |
| return err; | |
| /* retrieve response parameters */ | |
| 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]; | |
| return 0; | |
| } | |
| /** | |
| * 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) | |
| { | |
| 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; | |
| } |