123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Copyright 2013-2016 Freescale Semiconductor, Inc.
- * Copyright 2017 NXP
- */
- #include <fsl-mc/fsl_mc_sys.h>
- #include <fsl-mc/fsl_mc_cmd.h>
- #include <fsl-mc/fsl_dpni.h>
- int dpni_prepare_cfg(const struct dpni_cfg *cfg,
- uint8_t *cfg_buf)
- {
- uint64_t *params = (uint64_t *)cfg_buf;
- DPNI_PREP_CFG(params, cfg);
- return 0;
- }
- int dpni_extract_cfg(struct dpni_cfg *cfg,
- const uint8_t *cfg_buf)
- {
- uint64_t *params = (uint64_t *)cfg_buf;
- DPNI_EXT_CFG(params, cfg);
- return 0;
- }
- int dpni_open(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- int dpni_id,
- uint16_t *token)
- {
- struct mc_command cmd = { 0 };
- int err;
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_OPEN,
- cmd_flags,
- 0);
- DPNI_CMD_OPEN(cmd, dpni_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.header);
- return 0;
- }
- int dpni_close(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_CLOSE,
- cmd_flags,
- token);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_create(struct fsl_mc_io *mc_io,
- uint16_t dprc_token,
- uint32_t cmd_flags,
- const struct dpni_cfg *cfg,
- uint32_t *obj_id)
- {
- struct mc_command cmd = { 0 };
- int err;
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_CREATE,
- cmd_flags,
- dprc_token);
- DPNI_CMD_CREATE(cmd, cfg);
- /* send command to mc*/
- err = mc_send_command(mc_io, &cmd);
- if (err)
- return err;
- /* retrieve response parameters */
- MC_CMD_READ_OBJ_ID(cmd, *obj_id);
- return 0;
- }
- int dpni_destroy(struct fsl_mc_io *mc_io,
- uint16_t dprc_token,
- uint32_t cmd_flags,
- uint32_t obj_id)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_DESTROY,
- cmd_flags,
- dprc_token);
- /* set object id to destroy */
- CMD_DESTROY_SET_OBJ_ID_PARAM0(cmd, obj_id);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_set_pools(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- const struct dpni_pools_cfg *cfg)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_POOLS,
- cmd_flags,
- token);
- DPNI_CMD_SET_POOLS(cmd, cfg);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_enable(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_ENABLE,
- cmd_flags,
- token);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_disable(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_DISABLE,
- cmd_flags,
- token);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_reset(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_RESET,
- cmd_flags,
- token);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_get_attributes(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- struct dpni_attr *attr)
- {
- struct mc_command cmd = { 0 };
- int err;
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_ATTR,
- cmd_flags,
- token);
- /* send command to mc*/
- err = mc_send_command(mc_io, &cmd);
- if (err)
- return err;
- /* retrieve response parameters */
- DPNI_RSP_GET_ATTR(cmd, attr);
- return 0;
- }
- int dpni_set_errors_behavior(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- struct dpni_error_cfg *cfg)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_ERRORS_BEHAVIOR,
- cmd_flags,
- token);
- DPNI_CMD_SET_ERRORS_BEHAVIOR(cmd, cfg);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_set_buffer_layout(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- const struct dpni_buffer_layout *layout,
- enum dpni_queue_type type)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_BUFFER_LAYOUT,
- cmd_flags,
- token);
- DPNI_CMD_SET_BUFFER_LAYOUT(cmd, layout, type);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_get_qdid(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- uint16_t *qdid)
- {
- struct mc_command cmd = { 0 };
- int err;
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_QDID,
- cmd_flags,
- token);
- /* send command to mc*/
- err = mc_send_command(mc_io, &cmd);
- if (err)
- return err;
- /* retrieve response parameters */
- DPNI_RSP_GET_QDID(cmd, *qdid);
- return 0;
- }
- int dpni_get_tx_data_offset(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- uint16_t *data_offset)
- {
- struct mc_command cmd = { 0 };
- int err;
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_TX_DATA_OFFSET,
- cmd_flags,
- token);
- /* send command to mc*/
- err = mc_send_command(mc_io, &cmd);
- if (err)
- return err;
- /* retrieve response parameters */
- DPNI_RSP_GET_TX_DATA_OFFSET(cmd, *data_offset);
- return 0;
- }
- int dpni_set_link_cfg(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- const struct dpni_link_cfg *cfg)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_LINK_CFG,
- cmd_flags,
- token);
- DPNI_CMD_SET_LINK_CFG(cmd, cfg);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_get_link_state(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- struct dpni_link_state *state)
- {
- struct mc_command cmd = { 0 };
- int err;
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_LINK_STATE,
- cmd_flags,
- token);
- /* send command to mc*/
- err = mc_send_command(mc_io, &cmd);
- if (err)
- return err;
- /* retrieve response parameters */
- DPNI_RSP_GET_LINK_STATE(cmd, state);
- return 0;
- }
- int dpni_set_primary_mac_addr(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- const uint8_t mac_addr[6])
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_PRIM_MAC,
- cmd_flags,
- token);
- DPNI_CMD_SET_PRIMARY_MAC_ADDR(cmd, mac_addr);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_get_primary_mac_addr(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- uint8_t mac_addr[6])
- {
- struct mc_command cmd = { 0 };
- int err;
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_PRIM_MAC,
- cmd_flags,
- token);
- /* send command to mc*/
- err = mc_send_command(mc_io, &cmd);
- if (err)
- return err;
- /* retrieve response parameters */
- DPNI_RSP_GET_PRIMARY_MAC_ADDR(cmd, mac_addr);
- return 0;
- }
- int dpni_add_mac_addr(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- const uint8_t mac_addr[6])
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_ADD_MAC_ADDR,
- cmd_flags,
- token);
- DPNI_CMD_ADD_MAC_ADDR(cmd, mac_addr);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_remove_mac_addr(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- const uint8_t mac_addr[6])
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_REMOVE_MAC_ADDR,
- cmd_flags,
- token);
- DPNI_CMD_REMOVE_MAC_ADDR(cmd, mac_addr);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_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(DPNI_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;
- }
- int dpni_set_queue(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- enum dpni_queue_type type,
- uint8_t tc,
- uint8_t index,
- const struct dpni_queue *queue)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_QUEUE,
- cmd_flags,
- token);
- DPNI_CMD_SET_QUEUE(cmd, type, tc, index, queue);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_get_queue(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- enum dpni_queue_type type,
- uint8_t tc,
- uint8_t index,
- struct dpni_queue *queue)
- {
- struct mc_command cmd = { 0 };
- int err;
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_QUEUE,
- cmd_flags,
- token);
- DPNI_CMD_GET_QUEUE(cmd, type, tc, index);
- /* send command to mc*/
- err = mc_send_command(mc_io, &cmd);
- if (err)
- return err;
- /* retrieve response parameters */
- DPNI_RSP_GET_QUEUE(cmd, queue);
- return 0;
- }
- int dpni_set_tx_confirmation_mode(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- enum dpni_confirmation_mode mode)
- {
- struct dpni_tx_confirmation_mode *cmd_params;
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_SET_TX_CONFIRMATION_MODE,
- cmd_flags,
- token);
- cmd_params = (struct dpni_tx_confirmation_mode *)cmd.params;
- cmd_params->confirmation_mode = mode;
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
- int dpni_get_statistics(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token,
- uint8_t page,
- struct dpni_statistics *stat)
- {
- struct mc_command cmd = { 0 };
- int err;
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_GET_STATISTICS,
- cmd_flags, token);
- DPNI_CMD_GET_STATISTICS(cmd, page);
- /* send command to mc*/
- err = mc_send_command(mc_io, &cmd);
- if (err)
- return err;
- /* retrieve response parameters */
- DPNI_RSP_GET_STATISTICS(cmd, stat);
- return 0;
- }
- int dpni_reset_statistics(struct fsl_mc_io *mc_io,
- uint32_t cmd_flags,
- uint16_t token)
- {
- struct mc_command cmd = { 0 };
- /* prepare command */
- cmd.header = mc_encode_cmd_header(DPNI_CMDID_RESET_STATISTICS,
- cmd_flags, token);
- /* send command to mc*/
- return mc_send_command(mc_io, &cmd);
- }
|