116 lines
2.6 KiB
C
116 lines
2.6 KiB
C
|
/* SPDX-License-Identifier: GPL-2.0-or-later */
|
||
|
|
/*
|
||
|
|
STB6100 Silicon Tuner wrapper
|
||
|
|
Copyright (C)2009 Igor M. Liplianin (liplianin@me.by)
|
||
|
|
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/dvb/frontend.h>
|
||
|
|
#include <media/dvb_frontend.h>
|
||
|
|
|
||
|
|
static int stb6100_get_freq(struct dvb_frontend *fe, u32 *frequency)
|
||
|
|
{
|
||
|
|
struct dvb_frontend_ops *frontend_ops = &fe->ops;
|
||
|
|
struct dvb_tuner_ops *tuner_ops = &frontend_ops->tuner_ops;
|
||
|
|
int err = 0;
|
||
|
|
|
||
|
|
if (tuner_ops->get_frequency) {
|
||
|
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
|
frontend_ops->i2c_gate_ctrl(fe, 1);
|
||
|
|
|
||
|
|
err = tuner_ops->get_frequency(fe, frequency);
|
||
|
|
if (err < 0) {
|
||
|
|
printk("%s: Invalid parameter\n", __func__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
|
frontend_ops->i2c_gate_ctrl(fe, 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int stb6100_set_freq(struct dvb_frontend *fe, u32 frequency)
|
||
|
|
{
|
||
|
|
struct dvb_frontend_ops *frontend_ops = &fe->ops;
|
||
|
|
struct dvb_tuner_ops *tuner_ops = &frontend_ops->tuner_ops;
|
||
|
|
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
||
|
|
u32 bw = c->bandwidth_hz;
|
||
|
|
int err = 0;
|
||
|
|
|
||
|
|
c->frequency = frequency;
|
||
|
|
c->bandwidth_hz = 0; /* Don't adjust the bandwidth */
|
||
|
|
|
||
|
|
if (tuner_ops->set_params) {
|
||
|
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
|
frontend_ops->i2c_gate_ctrl(fe, 1);
|
||
|
|
|
||
|
|
err = tuner_ops->set_params(fe);
|
||
|
|
c->bandwidth_hz = bw;
|
||
|
|
if (err < 0) {
|
||
|
|
printk("%s: Invalid parameter\n", __func__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
|
frontend_ops->i2c_gate_ctrl(fe, 0);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int stb6100_get_bandw(struct dvb_frontend *fe, u32 *bandwidth)
|
||
|
|
{
|
||
|
|
struct dvb_frontend_ops *frontend_ops = &fe->ops;
|
||
|
|
struct dvb_tuner_ops *tuner_ops = &frontend_ops->tuner_ops;
|
||
|
|
int err = 0;
|
||
|
|
|
||
|
|
if (tuner_ops->get_bandwidth) {
|
||
|
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
|
frontend_ops->i2c_gate_ctrl(fe, 1);
|
||
|
|
|
||
|
|
err = tuner_ops->get_bandwidth(fe, bandwidth);
|
||
|
|
if (err < 0) {
|
||
|
|
printk(KERN_ERR "%s: Invalid parameter\n", __func__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
|
frontend_ops->i2c_gate_ctrl(fe, 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int stb6100_set_bandw(struct dvb_frontend *fe, u32 bandwidth)
|
||
|
|
{
|
||
|
|
struct dvb_frontend_ops *frontend_ops = &fe->ops;
|
||
|
|
struct dvb_tuner_ops *tuner_ops = &frontend_ops->tuner_ops;
|
||
|
|
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
||
|
|
u32 freq = c->frequency;
|
||
|
|
int err = 0;
|
||
|
|
|
||
|
|
c->bandwidth_hz = bandwidth;
|
||
|
|
c->frequency = 0; /* Don't adjust the frequency */
|
||
|
|
|
||
|
|
if (tuner_ops->set_params) {
|
||
|
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
|
frontend_ops->i2c_gate_ctrl(fe, 1);
|
||
|
|
|
||
|
|
err = tuner_ops->set_params(fe);
|
||
|
|
c->frequency = freq;
|
||
|
|
if (err < 0) {
|
||
|
|
printk(KERN_ERR "%s: Invalid parameter\n", __func__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
|
frontend_ops->i2c_gate_ctrl(fe, 0);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|