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