193 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Abilis Systems Single DVB-T Receiver4 * Copyright (C) 2008 Pierrick Hascoet <pierrick.hascoet@abilis.com>5 */6 7#include <linux/kernel.h>8#include "as102_drv.h"9#include "as10x_cmd.h"10 11/***************************/12/* FUNCTION DEFINITION */13/***************************/14 15/**16 * as10x_cmd_get_context - Send get context command to AS10x17 * @adap: pointer to AS10x bus adapter18 * @tag: context tag19 * @pvalue: pointer where to store context value read20 *21 * Return 0 on success or negative value in case of error.22 */23int as10x_cmd_get_context(struct as10x_bus_adapter_t *adap, uint16_t tag,24 uint32_t *pvalue)25{26 int error;27 struct as10x_cmd_t *pcmd, *prsp;28 29 pcmd = adap->cmd;30 prsp = adap->rsp;31 32 /* prepare command */33 as10x_cmd_build(pcmd, (++adap->cmd_xid),34 sizeof(pcmd->body.context.req));35 36 /* fill command */37 pcmd->body.context.req.proc_id = cpu_to_le16(CONTROL_PROC_CONTEXT);38 pcmd->body.context.req.tag = cpu_to_le16(tag);39 pcmd->body.context.req.type = cpu_to_le16(GET_CONTEXT_DATA);40 41 /* send command */42 if (adap->ops->xfer_cmd) {43 error = adap->ops->xfer_cmd(adap,44 (uint8_t *) pcmd,45 sizeof(pcmd->body.context.req)46 + HEADER_SIZE,47 (uint8_t *) prsp,48 sizeof(prsp->body.context.rsp)49 + HEADER_SIZE);50 } else {51 error = AS10X_CMD_ERROR;52 }53 54 if (error < 0)55 goto out;56 57 /* parse response: context command do not follow the common response */58 /* structure -> specific handling response parse required */59 error = as10x_context_rsp_parse(prsp, CONTROL_PROC_CONTEXT_RSP);60 61 if (error == 0) {62 /* Response OK -> get response data */63 *pvalue = le32_to_cpu((__force __le32)prsp->body.context.rsp.reg_val.u.value32);64 /* value returned is always a 32-bit value */65 }66 67out:68 return error;69}70 71/**72 * as10x_cmd_set_context - send set context command to AS10x73 * @adap: pointer to AS10x bus adapter74 * @tag: context tag75 * @value: value to set in context76 *77 * Return 0 on success or negative value in case of error.78 */79int as10x_cmd_set_context(struct as10x_bus_adapter_t *adap, uint16_t tag,80 uint32_t value)81{82 int error;83 struct as10x_cmd_t *pcmd, *prsp;84 85 pcmd = adap->cmd;86 prsp = adap->rsp;87 88 /* prepare command */89 as10x_cmd_build(pcmd, (++adap->cmd_xid),90 sizeof(pcmd->body.context.req));91 92 /* fill command */93 pcmd->body.context.req.proc_id = cpu_to_le16(CONTROL_PROC_CONTEXT);94 /* pcmd->body.context.req.reg_val.mode initialization is not required */95 pcmd->body.context.req.reg_val.u.value32 = (__force u32)cpu_to_le32(value);96 pcmd->body.context.req.tag = cpu_to_le16(tag);97 pcmd->body.context.req.type = cpu_to_le16(SET_CONTEXT_DATA);98 99 /* send command */100 if (adap->ops->xfer_cmd) {101 error = adap->ops->xfer_cmd(adap,102 (uint8_t *) pcmd,103 sizeof(pcmd->body.context.req)104 + HEADER_SIZE,105 (uint8_t *) prsp,106 sizeof(prsp->body.context.rsp)107 + HEADER_SIZE);108 } else {109 error = AS10X_CMD_ERROR;110 }111 112 if (error < 0)113 goto out;114 115 /* parse response: context command do not follow the common response */116 /* structure -> specific handling response parse required */117 error = as10x_context_rsp_parse(prsp, CONTROL_PROC_CONTEXT_RSP);118 119out:120 return error;121}122 123/**124 * as10x_cmd_eLNA_change_mode - send eLNA change mode command to AS10x125 * @adap: pointer to AS10x bus adapter126 * @mode: mode selected:127 * - ON : 0x0 => eLNA always ON128 * - OFF : 0x1 => eLNA always OFF129 * - AUTO : 0x2 => eLNA follow hysteresis parameters130 * to be ON or OFF131 *132 * Return 0 on success or negative value in case of error.133 */134int as10x_cmd_eLNA_change_mode(struct as10x_bus_adapter_t *adap, uint8_t mode)135{136 int error;137 struct as10x_cmd_t *pcmd, *prsp;138 139 pcmd = adap->cmd;140 prsp = adap->rsp;141 142 /* prepare command */143 as10x_cmd_build(pcmd, (++adap->cmd_xid),144 sizeof(pcmd->body.cfg_change_mode.req));145 146 /* fill command */147 pcmd->body.cfg_change_mode.req.proc_id =148 cpu_to_le16(CONTROL_PROC_ELNA_CHANGE_MODE);149 pcmd->body.cfg_change_mode.req.mode = mode;150 151 /* send command */152 if (adap->ops->xfer_cmd) {153 error = adap->ops->xfer_cmd(adap, (uint8_t *) pcmd,154 sizeof(pcmd->body.cfg_change_mode.req)155 + HEADER_SIZE, (uint8_t *) prsp,156 sizeof(prsp->body.cfg_change_mode.rsp)157 + HEADER_SIZE);158 } else {159 error = AS10X_CMD_ERROR;160 }161 162 if (error < 0)163 goto out;164 165 /* parse response */166 error = as10x_rsp_parse(prsp, CONTROL_PROC_ELNA_CHANGE_MODE_RSP);167 168out:169 return error;170}171 172/**173 * as10x_context_rsp_parse - Parse context command response174 * @prsp: pointer to AS10x command response buffer175 * @proc_id: id of the command176 *177 * Since the contex command response does not follow the common178 * response, a specific parse function is required.179 * Return 0 on success or negative value in case of error.180 */181int as10x_context_rsp_parse(struct as10x_cmd_t *prsp, uint16_t proc_id)182{183 int err;184 185 err = prsp->body.context.rsp.error;186 187 if ((err == 0) &&188 (le16_to_cpu(prsp->body.context.rsp.proc_id) == proc_id)) {189 return 0;190 }191 return AS10X_CMD_ERROR;192}193