2019-05-23 09:14:55 +00:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-or-later
|
2011-10-31 15:24:49 +00:00
|
|
|
/*
|
|
|
|
* Abilis Systems Single DVB-T Receiver
|
|
|
|
* Copyright (C) 2008 Pierrick Hascoet <pierrick.hascoet@abilis.com>
|
|
|
|
*/
|
2011-10-31 15:24:50 +00:00
|
|
|
|
2011-10-31 15:24:39 +00:00
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include "as102_drv.h"
|
|
|
|
#include "as10x_cmd.h"
|
|
|
|
|
|
|
|
/**
|
2011-10-31 15:24:51 +00:00
|
|
|
* as10x_cmd_add_PID_filter - send add filter command to AS10x
|
2011-11-06 19:31:50 +00:00
|
|
|
* @adap: pointer to AS10x bus adapter
|
2011-10-31 15:24:51 +00:00
|
|
|
* @filter: TSFilter filter for DVB-T
|
|
|
|
*
|
|
|
|
* Return 0 on success or negative value in case of error.
|
|
|
|
*/
|
2011-11-06 19:31:50 +00:00
|
|
|
int as10x_cmd_add_PID_filter(struct as10x_bus_adapter_t *adap,
|
2011-10-31 15:24:43 +00:00
|
|
|
struct as10x_ts_filter *filter)
|
|
|
|
{
|
|
|
|
int error;
|
|
|
|
struct as10x_cmd_t *pcmd, *prsp;
|
|
|
|
|
2011-11-06 19:31:50 +00:00
|
|
|
pcmd = adap->cmd;
|
|
|
|
prsp = adap->rsp;
|
2011-10-31 15:24:43 +00:00
|
|
|
|
|
|
|
/* prepare command */
|
2011-11-06 19:31:50 +00:00
|
|
|
as10x_cmd_build(pcmd, (++adap->cmd_xid),
|
2011-10-31 15:24:43 +00:00
|
|
|
sizeof(pcmd->body.add_pid_filter.req));
|
|
|
|
|
|
|
|
/* fill command */
|
|
|
|
pcmd->body.add_pid_filter.req.proc_id =
|
|
|
|
cpu_to_le16(CONTROL_PROC_SETFILTER);
|
|
|
|
pcmd->body.add_pid_filter.req.pid = cpu_to_le16(filter->pid);
|
|
|
|
pcmd->body.add_pid_filter.req.stream_type = filter->type;
|
|
|
|
|
|
|
|
if (filter->idx < 16)
|
|
|
|
pcmd->body.add_pid_filter.req.idx = filter->idx;
|
|
|
|
else
|
|
|
|
pcmd->body.add_pid_filter.req.idx = 0xFF;
|
|
|
|
|
|
|
|
/* send command */
|
2011-11-06 19:31:50 +00:00
|
|
|
if (adap->ops->xfer_cmd) {
|
|
|
|
error = adap->ops->xfer_cmd(adap, (uint8_t *) pcmd,
|
2011-10-31 15:24:43 +00:00
|
|
|
sizeof(pcmd->body.add_pid_filter.req)
|
|
|
|
+ HEADER_SIZE, (uint8_t *) prsp,
|
|
|
|
sizeof(prsp->body.add_pid_filter.rsp)
|
|
|
|
+ HEADER_SIZE);
|
|
|
|
} else {
|
|
|
|
error = AS10X_CMD_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (error < 0)
|
|
|
|
goto out;
|
|
|
|
|
|
|
|
/* parse response */
|
|
|
|
error = as10x_rsp_parse(prsp, CONTROL_PROC_SETFILTER_RSP);
|
|
|
|
|
|
|
|
if (error == 0) {
|
|
|
|
/* Response OK -> get response data */
|
|
|
|
filter->idx = prsp->body.add_pid_filter.rsp.filter_id;
|
|
|
|
}
|
2011-10-31 15:24:39 +00:00
|
|
|
|
|
|
|
out:
|
2011-10-31 15:24:43 +00:00
|
|
|
return error;
|
2011-10-31 15:24:39 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-10-31 15:24:51 +00:00
|
|
|
* as10x_cmd_del_PID_filter - Send delete filter command to AS10x
|
2011-11-06 19:31:50 +00:00
|
|
|
* @adap: pointer to AS10x bus adapte
|
2011-10-31 15:24:51 +00:00
|
|
|
* @pid_value: PID to delete
|
|
|
|
*
|
|
|
|
* Return 0 on success or negative value in case of error.
|
|
|
|
*/
|
2011-11-06 19:31:50 +00:00
|
|
|
int as10x_cmd_del_PID_filter(struct as10x_bus_adapter_t *adap,
|
2011-10-31 15:24:39 +00:00
|
|
|
uint16_t pid_value)
|
|
|
|
{
|
2011-10-31 15:24:43 +00:00
|
|
|
int error;
|
|
|
|
struct as10x_cmd_t *pcmd, *prsp;
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-11-06 19:31:50 +00:00
|
|
|
pcmd = adap->cmd;
|
|
|
|
prsp = adap->rsp;
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* prepare command */
|
2011-11-06 19:31:50 +00:00
|
|
|
as10x_cmd_build(pcmd, (++adap->cmd_xid),
|
2011-10-31 15:24:43 +00:00
|
|
|
sizeof(pcmd->body.del_pid_filter.req));
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* fill command */
|
|
|
|
pcmd->body.del_pid_filter.req.proc_id =
|
|
|
|
cpu_to_le16(CONTROL_PROC_REMOVEFILTER);
|
|
|
|
pcmd->body.del_pid_filter.req.pid = cpu_to_le16(pid_value);
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* send command */
|
2011-11-06 19:31:50 +00:00
|
|
|
if (adap->ops->xfer_cmd) {
|
|
|
|
error = adap->ops->xfer_cmd(adap, (uint8_t *) pcmd,
|
2011-10-31 15:24:43 +00:00
|
|
|
sizeof(pcmd->body.del_pid_filter.req)
|
|
|
|
+ HEADER_SIZE, (uint8_t *) prsp,
|
|
|
|
sizeof(prsp->body.del_pid_filter.rsp)
|
|
|
|
+ HEADER_SIZE);
|
|
|
|
} else {
|
|
|
|
error = AS10X_CMD_ERROR;
|
|
|
|
}
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
if (error < 0)
|
|
|
|
goto out;
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* parse response */
|
|
|
|
error = as10x_rsp_parse(prsp, CONTROL_PROC_REMOVEFILTER_RSP);
|
2011-10-31 15:24:39 +00:00
|
|
|
|
|
|
|
out:
|
2011-10-31 15:24:43 +00:00
|
|
|
return error;
|
2011-10-31 15:24:39 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-10-31 15:24:51 +00:00
|
|
|
* as10x_cmd_start_streaming - Send start streaming command to AS10x
|
2011-11-06 19:31:50 +00:00
|
|
|
* @adap: pointer to AS10x bus adapter
|
2011-10-31 15:24:51 +00:00
|
|
|
*
|
|
|
|
* Return 0 on success or negative value in case of error.
|
|
|
|
*/
|
2011-11-06 19:31:50 +00:00
|
|
|
int as10x_cmd_start_streaming(struct as10x_bus_adapter_t *adap)
|
2011-10-31 15:24:39 +00:00
|
|
|
{
|
2011-10-31 15:24:43 +00:00
|
|
|
int error;
|
|
|
|
struct as10x_cmd_t *pcmd, *prsp;
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-11-06 19:31:50 +00:00
|
|
|
pcmd = adap->cmd;
|
|
|
|
prsp = adap->rsp;
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* prepare command */
|
2011-11-06 19:31:50 +00:00
|
|
|
as10x_cmd_build(pcmd, (++adap->cmd_xid),
|
2011-10-31 15:24:43 +00:00
|
|
|
sizeof(pcmd->body.start_streaming.req));
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* fill command */
|
|
|
|
pcmd->body.start_streaming.req.proc_id =
|
|
|
|
cpu_to_le16(CONTROL_PROC_START_STREAMING);
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* send command */
|
2011-11-06 19:31:50 +00:00
|
|
|
if (adap->ops->xfer_cmd) {
|
|
|
|
error = adap->ops->xfer_cmd(adap, (uint8_t *) pcmd,
|
2011-10-31 15:24:43 +00:00
|
|
|
sizeof(pcmd->body.start_streaming.req)
|
|
|
|
+ HEADER_SIZE, (uint8_t *) prsp,
|
|
|
|
sizeof(prsp->body.start_streaming.rsp)
|
|
|
|
+ HEADER_SIZE);
|
|
|
|
} else {
|
|
|
|
error = AS10X_CMD_ERROR;
|
|
|
|
}
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
if (error < 0)
|
|
|
|
goto out;
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* parse response */
|
|
|
|
error = as10x_rsp_parse(prsp, CONTROL_PROC_START_STREAMING_RSP);
|
2011-10-31 15:24:39 +00:00
|
|
|
|
|
|
|
out:
|
2011-10-31 15:24:43 +00:00
|
|
|
return error;
|
2011-10-31 15:24:39 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-10-31 15:24:51 +00:00
|
|
|
* as10x_cmd_stop_streaming - Send stop streaming command to AS10x
|
2011-11-06 19:31:50 +00:00
|
|
|
* @adap: pointer to AS10x bus adapter
|
2011-10-31 15:24:51 +00:00
|
|
|
*
|
|
|
|
* Return 0 on success or negative value in case of error.
|
|
|
|
*/
|
2011-11-06 19:31:50 +00:00
|
|
|
int as10x_cmd_stop_streaming(struct as10x_bus_adapter_t *adap)
|
2011-10-31 15:24:39 +00:00
|
|
|
{
|
2011-10-31 15:24:43 +00:00
|
|
|
int8_t error;
|
|
|
|
struct as10x_cmd_t *pcmd, *prsp;
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-11-06 19:31:50 +00:00
|
|
|
pcmd = adap->cmd;
|
|
|
|
prsp = adap->rsp;
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* prepare command */
|
2011-11-06 19:31:50 +00:00
|
|
|
as10x_cmd_build(pcmd, (++adap->cmd_xid),
|
2011-10-31 15:24:43 +00:00
|
|
|
sizeof(pcmd->body.stop_streaming.req));
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* fill command */
|
|
|
|
pcmd->body.stop_streaming.req.proc_id =
|
|
|
|
cpu_to_le16(CONTROL_PROC_STOP_STREAMING);
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* send command */
|
2011-11-06 19:31:50 +00:00
|
|
|
if (adap->ops->xfer_cmd) {
|
|
|
|
error = adap->ops->xfer_cmd(adap, (uint8_t *) pcmd,
|
2011-10-31 15:24:43 +00:00
|
|
|
sizeof(pcmd->body.stop_streaming.req)
|
|
|
|
+ HEADER_SIZE, (uint8_t *) prsp,
|
|
|
|
sizeof(prsp->body.stop_streaming.rsp)
|
|
|
|
+ HEADER_SIZE);
|
|
|
|
} else {
|
|
|
|
error = AS10X_CMD_ERROR;
|
|
|
|
}
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
if (error < 0)
|
|
|
|
goto out;
|
2011-10-31 15:24:39 +00:00
|
|
|
|
2011-10-31 15:24:43 +00:00
|
|
|
/* parse response */
|
|
|
|
error = as10x_rsp_parse(prsp, CONTROL_PROC_STOP_STREAMING_RSP);
|
2011-10-31 15:24:39 +00:00
|
|
|
|
|
|
|
out:
|
2011-10-31 15:24:43 +00:00
|
|
|
return error;
|
2011-10-31 15:24:39 +00:00
|
|
|
}
|