1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Abilis Systems Single DVB-T Receiver
4 * 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 AS10x
17 * @adap: pointer to AS10x bus adapter
18 * @tag: context tag
19 * @pvalue: pointer where to store context value read
20 *
21 * Return 0 on success or negative value in case of error.
22 */
as10x_cmd_get_context(struct as10x_bus_adapter_t * adap,uint16_t tag,uint32_t * pvalue)23 int 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
67 out:
68 return error;
69 }
70
71 /**
72 * as10x_cmd_set_context - send set context command to AS10x
73 * @adap: pointer to AS10x bus adapter
74 * @tag: context tag
75 * @value: value to set in context
76 *
77 * Return 0 on success or negative value in case of error.
78 */
as10x_cmd_set_context(struct as10x_bus_adapter_t * adap,uint16_t tag,uint32_t value)79 int 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
119 out:
120 return error;
121 }
122
123 /**
124 * as10x_cmd_eLNA_change_mode - send eLNA change mode command to AS10x
125 * @adap: pointer to AS10x bus adapter
126 * @mode: mode selected:
127 * - ON : 0x0 => eLNA always ON
128 * - OFF : 0x1 => eLNA always OFF
129 * - AUTO : 0x2 => eLNA follow hysteresis parameters
130 * to be ON or OFF
131 *
132 * Return 0 on success or negative value in case of error.
133 */
as10x_cmd_eLNA_change_mode(struct as10x_bus_adapter_t * adap,uint8_t mode)134 int 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
168 out:
169 return error;
170 }
171
172 /**
173 * as10x_context_rsp_parse - Parse context command response
174 * @prsp: pointer to AS10x command response buffer
175 * @proc_id: id of the command
176 *
177 * Since the contex command response does not follow the common
178 * response, a specific parse function is required.
179 * Return 0 on success or negative value in case of error.
180 */
as10x_context_rsp_parse(struct as10x_cmd_t * prsp,uint16_t proc_id)181 int 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