1 /* 2 * Abilis Systems Single DVB-T Receiver 3 * Copyright (C) 2008 Pierrick Hascoet <pierrick.hascoet@abilis.com> 4 * 5 * This program is free software; you can redistribute it and/or modify 6 * it under the terms of the GNU General Public License as published by 7 * the Free Software Foundation; either version 2, or (at your option) 8 * any later version. 9 * 10 * This program is distributed in the hope that it will be useful, 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 13 * GNU General Public License for more details. 14 */ 15 16 #include <linux/kernel.h> 17 #include "as102_drv.h" 18 #include "as10x_cmd.h" 19 20 /***************************/ 21 /* FUNCTION DEFINITION */ 22 /***************************/ 23 24 /** 25 * as10x_cmd_get_context - Send get context command to AS10x 26 * @adap: pointer to AS10x bus adapter 27 * @tag: context tag 28 * @pvalue: pointer where to store context value read 29 * 30 * Return 0 on success or negative value in case of error. 31 */ 32 int as10x_cmd_get_context(struct as10x_bus_adapter_t *adap, uint16_t tag, 33 uint32_t *pvalue) 34 { 35 int error; 36 struct as10x_cmd_t *pcmd, *prsp; 37 38 pcmd = adap->cmd; 39 prsp = adap->rsp; 40 41 /* prepare command */ 42 as10x_cmd_build(pcmd, (++adap->cmd_xid), 43 sizeof(pcmd->body.context.req)); 44 45 /* fill command */ 46 pcmd->body.context.req.proc_id = cpu_to_le16(CONTROL_PROC_CONTEXT); 47 pcmd->body.context.req.tag = cpu_to_le16(tag); 48 pcmd->body.context.req.type = cpu_to_le16(GET_CONTEXT_DATA); 49 50 /* send command */ 51 if (adap->ops->xfer_cmd) { 52 error = adap->ops->xfer_cmd(adap, 53 (uint8_t *) pcmd, 54 sizeof(pcmd->body.context.req) 55 + HEADER_SIZE, 56 (uint8_t *) prsp, 57 sizeof(prsp->body.context.rsp) 58 + HEADER_SIZE); 59 } else { 60 error = AS10X_CMD_ERROR; 61 } 62 63 if (error < 0) 64 goto out; 65 66 /* parse response: context command do not follow the common response */ 67 /* structure -> specific handling response parse required */ 68 error = as10x_context_rsp_parse(prsp, CONTROL_PROC_CONTEXT_RSP); 69 70 if (error == 0) { 71 /* Response OK -> get response data */ 72 *pvalue = le32_to_cpu((__force __le32)prsp->body.context.rsp.reg_val.u.value32); 73 /* value returned is always a 32-bit value */ 74 } 75 76 out: 77 return error; 78 } 79 80 /** 81 * as10x_cmd_set_context - send set context command to AS10x 82 * @adap: pointer to AS10x bus adapter 83 * @tag: context tag 84 * @value: value to set in context 85 * 86 * Return 0 on success or negative value in case of error. 87 */ 88 int as10x_cmd_set_context(struct as10x_bus_adapter_t *adap, uint16_t tag, 89 uint32_t value) 90 { 91 int error; 92 struct as10x_cmd_t *pcmd, *prsp; 93 94 pcmd = adap->cmd; 95 prsp = adap->rsp; 96 97 /* prepare command */ 98 as10x_cmd_build(pcmd, (++adap->cmd_xid), 99 sizeof(pcmd->body.context.req)); 100 101 /* fill command */ 102 pcmd->body.context.req.proc_id = cpu_to_le16(CONTROL_PROC_CONTEXT); 103 /* pcmd->body.context.req.reg_val.mode initialization is not required */ 104 pcmd->body.context.req.reg_val.u.value32 = (__force u32)cpu_to_le32(value); 105 pcmd->body.context.req.tag = cpu_to_le16(tag); 106 pcmd->body.context.req.type = cpu_to_le16(SET_CONTEXT_DATA); 107 108 /* send command */ 109 if (adap->ops->xfer_cmd) { 110 error = adap->ops->xfer_cmd(adap, 111 (uint8_t *) pcmd, 112 sizeof(pcmd->body.context.req) 113 + HEADER_SIZE, 114 (uint8_t *) prsp, 115 sizeof(prsp->body.context.rsp) 116 + HEADER_SIZE); 117 } else { 118 error = AS10X_CMD_ERROR; 119 } 120 121 if (error < 0) 122 goto out; 123 124 /* parse response: context command do not follow the common response */ 125 /* structure -> specific handling response parse required */ 126 error = as10x_context_rsp_parse(prsp, CONTROL_PROC_CONTEXT_RSP); 127 128 out: 129 return error; 130 } 131 132 /** 133 * as10x_cmd_eLNA_change_mode - send eLNA change mode command to AS10x 134 * @adap: pointer to AS10x bus adapter 135 * @mode: mode selected: 136 * - ON : 0x0 => eLNA always ON 137 * - OFF : 0x1 => eLNA always OFF 138 * - AUTO : 0x2 => eLNA follow hysteresis parameters 139 * to be ON or OFF 140 * 141 * Return 0 on success or negative value in case of error. 142 */ 143 int as10x_cmd_eLNA_change_mode(struct as10x_bus_adapter_t *adap, uint8_t mode) 144 { 145 int error; 146 struct as10x_cmd_t *pcmd, *prsp; 147 148 pcmd = adap->cmd; 149 prsp = adap->rsp; 150 151 /* prepare command */ 152 as10x_cmd_build(pcmd, (++adap->cmd_xid), 153 sizeof(pcmd->body.cfg_change_mode.req)); 154 155 /* fill command */ 156 pcmd->body.cfg_change_mode.req.proc_id = 157 cpu_to_le16(CONTROL_PROC_ELNA_CHANGE_MODE); 158 pcmd->body.cfg_change_mode.req.mode = mode; 159 160 /* send command */ 161 if (adap->ops->xfer_cmd) { 162 error = adap->ops->xfer_cmd(adap, (uint8_t *) pcmd, 163 sizeof(pcmd->body.cfg_change_mode.req) 164 + HEADER_SIZE, (uint8_t *) prsp, 165 sizeof(prsp->body.cfg_change_mode.rsp) 166 + HEADER_SIZE); 167 } else { 168 error = AS10X_CMD_ERROR; 169 } 170 171 if (error < 0) 172 goto out; 173 174 /* parse response */ 175 error = as10x_rsp_parse(prsp, CONTROL_PROC_ELNA_CHANGE_MODE_RSP); 176 177 out: 178 return error; 179 } 180 181 /** 182 * as10x_context_rsp_parse - Parse context command response 183 * @prsp: pointer to AS10x command response buffer 184 * @proc_id: id of the command 185 * 186 * Since the contex command response does not follow the common 187 * response, a specific parse function is required. 188 * Return 0 on success or negative value in case of error. 189 */ 190 int as10x_context_rsp_parse(struct as10x_cmd_t *prsp, uint16_t proc_id) 191 { 192 int err; 193 194 err = prsp->body.context.rsp.error; 195 196 if ((err == 0) && 197 (le16_to_cpu(prsp->body.context.rsp.proc_id) == proc_id)) { 198 return 0; 199 } 200 return AS10X_CMD_ERROR; 201 } 202