/* 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);