162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Abilis Systems Single DVB-T Receiver 462306a36Sopenharmony_ci * Copyright (C) 2008 Pierrick Hascoet <pierrick.hascoet@abilis.com> 562306a36Sopenharmony_ci */ 662306a36Sopenharmony_ci 762306a36Sopenharmony_ci#include <linux/kernel.h> 862306a36Sopenharmony_ci#include "as102_drv.h" 962306a36Sopenharmony_ci#include "as10x_cmd.h" 1062306a36Sopenharmony_ci 1162306a36Sopenharmony_ci/***************************/ 1262306a36Sopenharmony_ci/* FUNCTION DEFINITION */ 1362306a36Sopenharmony_ci/***************************/ 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ci/** 1662306a36Sopenharmony_ci * as10x_cmd_get_context - Send get context command to AS10x 1762306a36Sopenharmony_ci * @adap: pointer to AS10x bus adapter 1862306a36Sopenharmony_ci * @tag: context tag 1962306a36Sopenharmony_ci * @pvalue: pointer where to store context value read 2062306a36Sopenharmony_ci * 2162306a36Sopenharmony_ci * Return 0 on success or negative value in case of error. 2262306a36Sopenharmony_ci */ 2362306a36Sopenharmony_ciint as10x_cmd_get_context(struct as10x_bus_adapter_t *adap, uint16_t tag, 2462306a36Sopenharmony_ci uint32_t *pvalue) 2562306a36Sopenharmony_ci{ 2662306a36Sopenharmony_ci int error; 2762306a36Sopenharmony_ci struct as10x_cmd_t *pcmd, *prsp; 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci pcmd = adap->cmd; 3062306a36Sopenharmony_ci prsp = adap->rsp; 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_ci /* prepare command */ 3362306a36Sopenharmony_ci as10x_cmd_build(pcmd, (++adap->cmd_xid), 3462306a36Sopenharmony_ci sizeof(pcmd->body.context.req)); 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_ci /* fill command */ 3762306a36Sopenharmony_ci pcmd->body.context.req.proc_id = cpu_to_le16(CONTROL_PROC_CONTEXT); 3862306a36Sopenharmony_ci pcmd->body.context.req.tag = cpu_to_le16(tag); 3962306a36Sopenharmony_ci pcmd->body.context.req.type = cpu_to_le16(GET_CONTEXT_DATA); 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ci /* send command */ 4262306a36Sopenharmony_ci if (adap->ops->xfer_cmd) { 4362306a36Sopenharmony_ci error = adap->ops->xfer_cmd(adap, 4462306a36Sopenharmony_ci (uint8_t *) pcmd, 4562306a36Sopenharmony_ci sizeof(pcmd->body.context.req) 4662306a36Sopenharmony_ci + HEADER_SIZE, 4762306a36Sopenharmony_ci (uint8_t *) prsp, 4862306a36Sopenharmony_ci sizeof(prsp->body.context.rsp) 4962306a36Sopenharmony_ci + HEADER_SIZE); 5062306a36Sopenharmony_ci } else { 5162306a36Sopenharmony_ci error = AS10X_CMD_ERROR; 5262306a36Sopenharmony_ci } 5362306a36Sopenharmony_ci 5462306a36Sopenharmony_ci if (error < 0) 5562306a36Sopenharmony_ci goto out; 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ci /* parse response: context command do not follow the common response */ 5862306a36Sopenharmony_ci /* structure -> specific handling response parse required */ 5962306a36Sopenharmony_ci error = as10x_context_rsp_parse(prsp, CONTROL_PROC_CONTEXT_RSP); 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci if (error == 0) { 6262306a36Sopenharmony_ci /* Response OK -> get response data */ 6362306a36Sopenharmony_ci *pvalue = le32_to_cpu((__force __le32)prsp->body.context.rsp.reg_val.u.value32); 6462306a36Sopenharmony_ci /* value returned is always a 32-bit value */ 6562306a36Sopenharmony_ci } 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ciout: 6862306a36Sopenharmony_ci return error; 6962306a36Sopenharmony_ci} 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_ci/** 7262306a36Sopenharmony_ci * as10x_cmd_set_context - send set context command to AS10x 7362306a36Sopenharmony_ci * @adap: pointer to AS10x bus adapter 7462306a36Sopenharmony_ci * @tag: context tag 7562306a36Sopenharmony_ci * @value: value to set in context 7662306a36Sopenharmony_ci * 7762306a36Sopenharmony_ci * Return 0 on success or negative value in case of error. 7862306a36Sopenharmony_ci */ 7962306a36Sopenharmony_ciint as10x_cmd_set_context(struct as10x_bus_adapter_t *adap, uint16_t tag, 8062306a36Sopenharmony_ci uint32_t value) 8162306a36Sopenharmony_ci{ 8262306a36Sopenharmony_ci int error; 8362306a36Sopenharmony_ci struct as10x_cmd_t *pcmd, *prsp; 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_ci pcmd = adap->cmd; 8662306a36Sopenharmony_ci prsp = adap->rsp; 8762306a36Sopenharmony_ci 8862306a36Sopenharmony_ci /* prepare command */ 8962306a36Sopenharmony_ci as10x_cmd_build(pcmd, (++adap->cmd_xid), 9062306a36Sopenharmony_ci sizeof(pcmd->body.context.req)); 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci /* fill command */ 9362306a36Sopenharmony_ci pcmd->body.context.req.proc_id = cpu_to_le16(CONTROL_PROC_CONTEXT); 9462306a36Sopenharmony_ci /* pcmd->body.context.req.reg_val.mode initialization is not required */ 9562306a36Sopenharmony_ci pcmd->body.context.req.reg_val.u.value32 = (__force u32)cpu_to_le32(value); 9662306a36Sopenharmony_ci pcmd->body.context.req.tag = cpu_to_le16(tag); 9762306a36Sopenharmony_ci pcmd->body.context.req.type = cpu_to_le16(SET_CONTEXT_DATA); 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci /* send command */ 10062306a36Sopenharmony_ci if (adap->ops->xfer_cmd) { 10162306a36Sopenharmony_ci error = adap->ops->xfer_cmd(adap, 10262306a36Sopenharmony_ci (uint8_t *) pcmd, 10362306a36Sopenharmony_ci sizeof(pcmd->body.context.req) 10462306a36Sopenharmony_ci + HEADER_SIZE, 10562306a36Sopenharmony_ci (uint8_t *) prsp, 10662306a36Sopenharmony_ci sizeof(prsp->body.context.rsp) 10762306a36Sopenharmony_ci + HEADER_SIZE); 10862306a36Sopenharmony_ci } else { 10962306a36Sopenharmony_ci error = AS10X_CMD_ERROR; 11062306a36Sopenharmony_ci } 11162306a36Sopenharmony_ci 11262306a36Sopenharmony_ci if (error < 0) 11362306a36Sopenharmony_ci goto out; 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci /* parse response: context command do not follow the common response */ 11662306a36Sopenharmony_ci /* structure -> specific handling response parse required */ 11762306a36Sopenharmony_ci error = as10x_context_rsp_parse(prsp, CONTROL_PROC_CONTEXT_RSP); 11862306a36Sopenharmony_ci 11962306a36Sopenharmony_ciout: 12062306a36Sopenharmony_ci return error; 12162306a36Sopenharmony_ci} 12262306a36Sopenharmony_ci 12362306a36Sopenharmony_ci/** 12462306a36Sopenharmony_ci * as10x_cmd_eLNA_change_mode - send eLNA change mode command to AS10x 12562306a36Sopenharmony_ci * @adap: pointer to AS10x bus adapter 12662306a36Sopenharmony_ci * @mode: mode selected: 12762306a36Sopenharmony_ci * - ON : 0x0 => eLNA always ON 12862306a36Sopenharmony_ci * - OFF : 0x1 => eLNA always OFF 12962306a36Sopenharmony_ci * - AUTO : 0x2 => eLNA follow hysteresis parameters 13062306a36Sopenharmony_ci * to be ON or OFF 13162306a36Sopenharmony_ci * 13262306a36Sopenharmony_ci * Return 0 on success or negative value in case of error. 13362306a36Sopenharmony_ci */ 13462306a36Sopenharmony_ciint as10x_cmd_eLNA_change_mode(struct as10x_bus_adapter_t *adap, uint8_t mode) 13562306a36Sopenharmony_ci{ 13662306a36Sopenharmony_ci int error; 13762306a36Sopenharmony_ci struct as10x_cmd_t *pcmd, *prsp; 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_ci pcmd = adap->cmd; 14062306a36Sopenharmony_ci prsp = adap->rsp; 14162306a36Sopenharmony_ci 14262306a36Sopenharmony_ci /* prepare command */ 14362306a36Sopenharmony_ci as10x_cmd_build(pcmd, (++adap->cmd_xid), 14462306a36Sopenharmony_ci sizeof(pcmd->body.cfg_change_mode.req)); 14562306a36Sopenharmony_ci 14662306a36Sopenharmony_ci /* fill command */ 14762306a36Sopenharmony_ci pcmd->body.cfg_change_mode.req.proc_id = 14862306a36Sopenharmony_ci cpu_to_le16(CONTROL_PROC_ELNA_CHANGE_MODE); 14962306a36Sopenharmony_ci pcmd->body.cfg_change_mode.req.mode = mode; 15062306a36Sopenharmony_ci 15162306a36Sopenharmony_ci /* send command */ 15262306a36Sopenharmony_ci if (adap->ops->xfer_cmd) { 15362306a36Sopenharmony_ci error = adap->ops->xfer_cmd(adap, (uint8_t *) pcmd, 15462306a36Sopenharmony_ci sizeof(pcmd->body.cfg_change_mode.req) 15562306a36Sopenharmony_ci + HEADER_SIZE, (uint8_t *) prsp, 15662306a36Sopenharmony_ci sizeof(prsp->body.cfg_change_mode.rsp) 15762306a36Sopenharmony_ci + HEADER_SIZE); 15862306a36Sopenharmony_ci } else { 15962306a36Sopenharmony_ci error = AS10X_CMD_ERROR; 16062306a36Sopenharmony_ci } 16162306a36Sopenharmony_ci 16262306a36Sopenharmony_ci if (error < 0) 16362306a36Sopenharmony_ci goto out; 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_ci /* parse response */ 16662306a36Sopenharmony_ci error = as10x_rsp_parse(prsp, CONTROL_PROC_ELNA_CHANGE_MODE_RSP); 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ciout: 16962306a36Sopenharmony_ci return error; 17062306a36Sopenharmony_ci} 17162306a36Sopenharmony_ci 17262306a36Sopenharmony_ci/** 17362306a36Sopenharmony_ci * as10x_context_rsp_parse - Parse context command response 17462306a36Sopenharmony_ci * @prsp: pointer to AS10x command response buffer 17562306a36Sopenharmony_ci * @proc_id: id of the command 17662306a36Sopenharmony_ci * 17762306a36Sopenharmony_ci * Since the contex command response does not follow the common 17862306a36Sopenharmony_ci * response, a specific parse function is required. 17962306a36Sopenharmony_ci * Return 0 on success or negative value in case of error. 18062306a36Sopenharmony_ci */ 18162306a36Sopenharmony_ciint as10x_context_rsp_parse(struct as10x_cmd_t *prsp, uint16_t proc_id) 18262306a36Sopenharmony_ci{ 18362306a36Sopenharmony_ci int err; 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_ci err = prsp->body.context.rsp.error; 18662306a36Sopenharmony_ci 18762306a36Sopenharmony_ci if ((err == 0) && 18862306a36Sopenharmony_ci (le16_to_cpu(prsp->body.context.rsp.proc_id) == proc_id)) { 18962306a36Sopenharmony_ci return 0; 19062306a36Sopenharmony_ci } 19162306a36Sopenharmony_ci return AS10X_CMD_ERROR; 19262306a36Sopenharmony_ci} 193