123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397 |
- // 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_destroy() - Destroy the DPDMAI object and release all its resources.
- * @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_destroy(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_DESTROY,
- cmd_flags, token);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- EXPORT_SYMBOL_GPL(dpdmai_destroy);
- /**
- * 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");
|