as10x_cmd_cfg.c

  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 */
 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 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 */
 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 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 */
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 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 */
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}