| /* Copyright 2013-2014 Freescale Semiconductor Inc. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are met: |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * * Neither the name of the above-listed copyright holders nor the |
| * names of any contributors may be used to endorse or promote products |
| * derived from this software without specific prior written permission. |
| * |
| * |
| * ALTERNATIVELY, this software may be distributed under the terms of the |
| * GNU General Public License ("GPL") as published by the Free Software |
| * Foundation, either version 2 of that License or (at your option) any |
| * later version. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE |
| * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| * POSSIBILITY OF SUCH DAMAGE. |
| */ |
| #include "../include/mc-sys.h" |
| #include "../include/mc-cmd.h" |
| #include "../include/dpbp.h" |
| #include "../include/dpbp-cmd.h" |
| |
| int dpbp_open(struct fsl_mc_io *mc_io, int dpbp_id, uint16_t *token) |
| { |
| struct mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_OPEN, |
| MC_CMD_PRI_LOW, 0); |
| cmd.params[0] |= mc_enc(0, 32, dpbp_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 err; |
| } |
| EXPORT_SYMBOL(dpbp_open); |
| |
| int dpbp_close(struct fsl_mc_io *mc_io, uint16_t token) |
| { |
| struct mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_CLOSE, MC_CMD_PRI_HIGH, |
| token); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| EXPORT_SYMBOL(dpbp_close); |
| |
| int dpbp_create(struct fsl_mc_io *mc_io, |
| const struct dpbp_cfg *cfg, |
| uint16_t *token) |
| { |
| struct mc_command cmd = { 0 }; |
| int err; |
| |
| (void)(cfg); /* unused */ |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_CREATE, |
| MC_CMD_PRI_LOW, 0); |
| |
| /* 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 dpbp_destroy(struct fsl_mc_io *mc_io, uint16_t token) |
| { |
| struct mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_DESTROY, |
| MC_CMD_PRI_LOW, token); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| |
| int dpbp_enable(struct fsl_mc_io *mc_io, uint16_t token) |
| { |
| struct mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_ENABLE, MC_CMD_PRI_LOW, |
| token); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| EXPORT_SYMBOL(dpbp_enable); |
| |
| int dpbp_disable(struct fsl_mc_io *mc_io, uint16_t token) |
| { |
| struct mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_DISABLE, |
| MC_CMD_PRI_LOW, token); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| EXPORT_SYMBOL(dpbp_disable); |
| |
| int dpbp_is_enabled(struct fsl_mc_io *mc_io, uint16_t token, int *en) |
| { |
| struct mc_command cmd = { 0 }; |
| int err; |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_IS_ENABLED, MC_CMD_PRI_LOW, |
| token); |
| |
| /* send command to mc*/ |
| err = mc_send_command(mc_io, &cmd); |
| if (err) |
| return err; |
| |
| /* retrieve response parameters */ |
| *en = (int)mc_dec(cmd.params[0], 0, 1); |
| |
| return 0; |
| } |
| |
| int dpbp_reset(struct fsl_mc_io *mc_io, uint16_t token) |
| { |
| struct mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_RESET, |
| MC_CMD_PRI_LOW, token); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| |
| int dpbp_set_irq(struct fsl_mc_io *mc_io, |
| uint16_t token, |
| uint8_t irq_index, |
| uint64_t irq_paddr, |
| uint32_t irq_val, |
| int user_irq_id) |
| { |
| struct mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_SET_IRQ, |
| MC_CMD_PRI_LOW, token); |
| cmd.params[0] |= mc_enc(0, 8, irq_index); |
| cmd.params[0] |= mc_enc(32, 32, irq_val); |
| cmd.params[1] |= mc_enc(0, 64, irq_paddr); |
| cmd.params[2] |= mc_enc(0, 32, user_irq_id); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| |
| int dpbp_get_irq(struct fsl_mc_io *mc_io, |
| uint16_t token, |
| uint8_t irq_index, |
| int *type, |
| uint64_t *irq_paddr, |
| uint32_t *irq_val, |
| int *user_irq_id) |
| { |
| struct mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_GET_IRQ, |
| MC_CMD_PRI_LOW, token); |
| cmd.params[0] |= mc_enc(32, 8, irq_index); |
| |
| /* send command to mc*/ |
| err = mc_send_command(mc_io, &cmd); |
| if (err) |
| return err; |
| |
| /* retrieve response parameters */ |
| *irq_val = (uint32_t)mc_dec(cmd.params[0], 0, 32); |
| *irq_paddr = (uint64_t)mc_dec(cmd.params[1], 0, 64); |
| *user_irq_id = (int)mc_dec(cmd.params[2], 0, 32); |
| *type = (int)mc_dec(cmd.params[2], 32, 32); |
| return 0; |
| } |
| |
| int dpbp_set_irq_enable(struct fsl_mc_io *mc_io, |
| uint16_t token, |
| uint8_t irq_index, |
| uint8_t en) |
| { |
| struct mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_SET_IRQ_ENABLE, |
| MC_CMD_PRI_LOW, token); |
| cmd.params[0] |= mc_enc(0, 8, en); |
| cmd.params[0] |= mc_enc(32, 8, irq_index); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| |
| int dpbp_get_irq_enable(struct fsl_mc_io *mc_io, |
| uint16_t token, |
| uint8_t irq_index, |
| uint8_t *en) |
| { |
| struct mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_GET_IRQ_ENABLE, |
| MC_CMD_PRI_LOW, token); |
| cmd.params[0] |= mc_enc(32, 8, irq_index); |
| |
| /* send command to mc*/ |
| err = mc_send_command(mc_io, &cmd); |
| if (err) |
| return err; |
| |
| /* retrieve response parameters */ |
| *en = (uint8_t)mc_dec(cmd.params[0], 0, 8); |
| return 0; |
| } |
| |
| int dpbp_set_irq_mask(struct fsl_mc_io *mc_io, |
| uint16_t token, |
| uint8_t irq_index, |
| uint32_t mask) |
| { |
| struct mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_SET_IRQ_MASK, |
| MC_CMD_PRI_LOW, token); |
| cmd.params[0] |= mc_enc(0, 32, mask); |
| cmd.params[0] |= mc_enc(32, 8, irq_index); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| |
| int dpbp_get_irq_mask(struct fsl_mc_io *mc_io, |
| uint16_t token, |
| uint8_t irq_index, |
| uint32_t *mask) |
| { |
| struct mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_GET_IRQ_MASK, |
| MC_CMD_PRI_LOW, token); |
| cmd.params[0] |= mc_enc(32, 8, irq_index); |
| |
| /* send command to mc*/ |
| err = mc_send_command(mc_io, &cmd); |
| if (err) |
| return err; |
| |
| /* retrieve response parameters */ |
| *mask = (uint32_t)mc_dec(cmd.params[0], 0, 32); |
| return 0; |
| } |
| |
| int dpbp_get_irq_status(struct fsl_mc_io *mc_io, |
| uint16_t token, |
| uint8_t irq_index, |
| uint32_t *status) |
| { |
| struct mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_GET_IRQ_STATUS, |
| MC_CMD_PRI_LOW, token); |
| cmd.params[0] |= mc_enc(32, 8, irq_index); |
| |
| /* send command to mc*/ |
| err = mc_send_command(mc_io, &cmd); |
| if (err) |
| return err; |
| |
| /* retrieve response parameters */ |
| *status = (uint32_t)mc_dec(cmd.params[0], 0, 32); |
| return 0; |
| } |
| |
| int dpbp_clear_irq_status(struct fsl_mc_io *mc_io, |
| uint16_t token, |
| uint8_t irq_index, |
| uint32_t status) |
| { |
| struct mc_command cmd = { 0 }; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_CLEAR_IRQ_STATUS, |
| MC_CMD_PRI_LOW, token); |
| cmd.params[0] |= mc_enc(0, 32, status); |
| cmd.params[0] |= mc_enc(32, 8, irq_index); |
| |
| /* send command to mc*/ |
| return mc_send_command(mc_io, &cmd); |
| } |
| |
| int dpbp_get_attributes(struct fsl_mc_io *mc_io, |
| uint16_t token, |
| struct dpbp_attr *attr) |
| { |
| struct mc_command cmd = { 0 }; |
| int err; |
| |
| /* prepare command */ |
| cmd.header = mc_encode_cmd_header(DPBP_CMDID_GET_ATTR, |
| MC_CMD_PRI_LOW, token); |
| |
| /* send command to mc*/ |
| err = mc_send_command(mc_io, &cmd); |
| if (err) |
| return err; |
| |
| /* retrieve response parameters */ |
| attr->bpid = (uint16_t)mc_dec(cmd.params[0], 16, 16); |
| attr->id = (int)mc_dec(cmd.params[0], 32, 32); |
| attr->version.major = (uint16_t)mc_dec(cmd.params[1], 0, 16); |
| attr->version.minor = (uint16_t)mc_dec(cmd.params[1], 16, 16); |
| return 0; |
| } |
| EXPORT_SYMBOL(dpbp_get_attributes); |