| // SPDX-License-Identifier: GPL-2.0 |
| // Copyright 2019 NXP |
| |
| #include <linux/module.h> |
| #include <linux/types.h> |
| #include <linux/io.h> |
| #include <linux/fsl/mc.h> |
| #include "dpdmai.h" |
| |
| struct dpdmai_rsp_get_attributes { |
| __le32 id; |
| u8 num_of_priorities; |
| u8 pad0[3]; |
| __le16 major; |
| __le16 minor; |
| }; |
| |
| struct dpdmai_cmd_queue { |
| __le32 dest_id; |
| u8 priority; |
| u8 queue; |
| u8 dest_type; |
| u8 pad; |
| __le64 user_ctx; |
| union { |
| __le32 options; |
| __le32 fqid; |
| }; |
| }; |
| |
| struct dpdmai_rsp_get_tx_queue { |
| __le64 pad; |
| __le32 fqid; |
| }; |
| |
| #define MC_CMD_OP(_cmd, _param, _offset, _width, _type, _arg) \ |
| ((_cmd).params[_param] |= mc_enc((_offset), (_width), _arg)) |
| |
| /* cmd, param, offset, width, type, arg_name */ |
| #define DPDMAI_CMD_CREATE(cmd, cfg) \ |
| do { \ |
| MC_CMD_OP(cmd, 0, 8, 8, u8, (cfg)->priorities[0]);\ |
| MC_CMD_OP(cmd, 0, 16, 8, u8, (cfg)->priorities[1]);\ |
| } while (0) |
| |
| static inline u64 mc_enc(int lsoffset, int width, u64 val) |
| { |
| return (val & MAKE_UMASK64(width)) << lsoffset; |
| } |
| |
| /** |
| * dpdmai_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_' |
| * @dpdmai_id: DPDMAI 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 dpdmai_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 dpdmai_open(struct fsl_mc_io *mc_io, u32 cmd_flags, |
| int dpdmai_id, u16 *token) |
| { |
| struct fsl_mc_command cmd = { 0 }; |
| __le64 *cmd_dpdmai_id; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPDMAI_CMDID_OPEN, |
| cmd_flags, 0); |
| |
| cmd_dpdmai_id = cmd.params; |
| *cmd_dpdmai_id = cpu_to_le32(dpdmai_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; |
| } |
| EXPORT_SYMBOL_GPL(dpdmai_open); |
| |
| /** |
| * dpdmai_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 DPDMAI 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 dpdmai_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(DPDMAI_CMDID_CLOSE, |
| cmd_flags, token); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| EXPORT_SYMBOL_GPL(dpdmai_close); |
| |
| /** |
| * dpdmai_create() - Create the DPDMAI object |
| * @mc_io: Pointer to MC portal's I/O object |
| * @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_' |
| * @cfg: Configuration structure |
| * @token: Returned token; use in subsequent API calls |
| * |
| * Create the DPDMAI object, allocate required resources and |
| * perform required initialization. |
| * |
| * The object can be created either by declaring it in the |
| * DPL file, or by calling this 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 calls to |
| * this specific object. For objects that are created using the |
| * DPL file, call dpdmai_open() function to get an authentication |
| * token first. |
| * |
| * Return: '0' on Success; Error code otherwise. |
| */ |
| int dpdmai_create(struct fsl_mc_io *mc_io, u32 cmd_flags, |
| const struct dpdmai_cfg *cfg, u16 *token) |
| { |
| struct fsl_mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPDMAI_CMDID_CREATE, |
| cmd_flags, 0); |
| DPDMAI_CMD_CREATE(cmd, cfg); |
| |
| /* 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; |
| } |
| |
| /** |
| * dpdmai_enable() - Enable the DPDMAI, 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 DPDMAI object |
| * |
| * Return: '0' on Success; Error code otherwise. |
| */ |
| int dpdmai_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(DPDMAI_CMDID_ENABLE, |
| cmd_flags, token); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| EXPORT_SYMBOL_GPL(dpdmai_enable); |
| |
| /** |
| * dpdmai_disable() - Disable the DPDMAI, 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 DPDMAI object |
| * |
| * Return: '0' on Success; Error code otherwise. |
| */ |
| int dpdmai_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(DPDMAI_CMDID_DISABLE, |
| cmd_flags, token); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| EXPORT_SYMBOL_GPL(dpdmai_disable); |
| |
| /** |
| * dpdmai_reset() - Reset the DPDMAI, 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 DPDMAI object |
| * |
| * Return: '0' on Success; Error code otherwise. |
| */ |
| int dpdmai_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(DPDMAI_CMDID_RESET, |
| cmd_flags, token); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| EXPORT_SYMBOL_GPL(dpdmai_reset); |
| |
| /** |
| * dpdmai_get_attributes() - Retrieve DPDMAI 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 DPDMAI object |
| * @attr: Returned object's attributes |
| * |
| * Return: '0' on Success; Error code otherwise. |
| */ |
| int dpdmai_get_attributes(struct fsl_mc_io *mc_io, u32 cmd_flags, |
| u16 token, struct dpdmai_attr *attr) |
| { |
| struct dpdmai_rsp_get_attributes *rsp_params; |
| struct fsl_mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPDMAI_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 dpdmai_rsp_get_attributes *)cmd.params; |
| attr->id = le32_to_cpu(rsp_params->id); |
| attr->version.major = le16_to_cpu(rsp_params->major); |
| attr->version.minor = le16_to_cpu(rsp_params->minor); |
| attr->num_of_priorities = rsp_params->num_of_priorities; |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(dpdmai_get_attributes); |
| |
| /** |
| * dpdmai_set_rx_queue() - Set Rx queue 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 DPDMAI object |
| * @priority: Select the queue relative to number of |
| * priorities configured at DPDMAI creation |
| * @cfg: Rx queue configuration |
| * |
| * Return: '0' on Success; Error code otherwise. |
| */ |
| int dpdmai_set_rx_queue(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token, |
| u8 priority, const struct dpdmai_rx_queue_cfg *cfg) |
| { |
| struct dpdmai_cmd_queue *cmd_params; |
| struct fsl_mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPDMAI_CMDID_SET_RX_QUEUE, |
| cmd_flags, token); |
| |
| cmd_params = (struct dpdmai_cmd_queue *)cmd.params; |
| cmd_params->dest_id = cpu_to_le32(cfg->dest_cfg.dest_id); |
| cmd_params->priority = cfg->dest_cfg.priority; |
| cmd_params->queue = priority; |
| cmd_params->dest_type = cfg->dest_cfg.dest_type; |
| cmd_params->user_ctx = cpu_to_le64(cfg->user_ctx); |
| cmd_params->options = cpu_to_le32(cfg->options); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| EXPORT_SYMBOL_GPL(dpdmai_set_rx_queue); |
| |
| /** |
| * dpdmai_get_rx_queue() - Retrieve Rx queue 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 DPDMAI object |
| * @priority: Select the queue relative to number of |
| * priorities configured at DPDMAI creation |
| * @attr: Returned Rx queue attributes |
| * |
| * Return: '0' on Success; Error code otherwise. |
| */ |
| int dpdmai_get_rx_queue(struct fsl_mc_io *mc_io, u32 cmd_flags, u16 token, |
| u8 priority, struct dpdmai_rx_queue_attr *attr) |
| { |
| struct dpdmai_cmd_queue *cmd_params; |
| struct fsl_mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPDMAI_CMDID_GET_RX_QUEUE, |
| cmd_flags, token); |
| |
| cmd_params = (struct dpdmai_cmd_queue *)cmd.params; |
| cmd_params->queue = priority; |
| |
| /* send command to mc*/ |
| err = mc_send_command(mc_io, &cmd); |
| if (err) |
| return err; |
| |
| /* retrieve response parameters */ |
| attr->dest_cfg.dest_id = le32_to_cpu(cmd_params->dest_id); |
| attr->dest_cfg.priority = cmd_params->priority; |
| attr->dest_cfg.dest_type = cmd_params->dest_type; |
| attr->user_ctx = le64_to_cpu(cmd_params->user_ctx); |
| attr->fqid = le32_to_cpu(cmd_params->fqid); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(dpdmai_get_rx_queue); |
| |
| /** |
| * dpdmai_get_tx_queue() - Retrieve Tx queue 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 DPDMAI object |
| * @priority: Select the queue relative to number of |
| * priorities configured at DPDMAI creation |
| * @fqid: Returned Tx queue |
| * |
| * Return: '0' on Success; Error code otherwise. |
| */ |
| int dpdmai_get_tx_queue(struct fsl_mc_io *mc_io, u32 cmd_flags, |
| u16 token, u8 priority, u32 *fqid) |
| { |
| struct dpdmai_rsp_get_tx_queue *rsp_params; |
| struct dpdmai_cmd_queue *cmd_params; |
| struct fsl_mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPDMAI_CMDID_GET_TX_QUEUE, |
| cmd_flags, token); |
| |
| cmd_params = (struct dpdmai_cmd_queue *)cmd.params; |
| cmd_params->queue = priority; |
| |
| /* send command to mc*/ |
| err = mc_send_command(mc_io, &cmd); |
| if (err) |
| return err; |
| |
| /* retrieve response parameters */ |
| |
| rsp_params = (struct dpdmai_rsp_get_tx_queue *)cmd.params; |
| *fqid = le32_to_cpu(rsp_params->fqid); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(dpdmai_get_tx_queue); |
| |
| MODULE_LICENSE("GPL v2"); |