mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-29 15:43:59 +08:00
139 lines
3.5 KiB
C
139 lines
3.5 KiB
C
|
/*
|
||
|
STB6100 Silicon Tuner wrapper
|
||
|
Copyright (C)2009 Igor M. Liplianin (liplianin@me.by)
|
||
|
|
||
|
This program is free software; you can redistribute it and/or modify
|
||
|
it under the terms of the GNU General Public License as published by
|
||
|
the Free Software Foundation; either version 2 of the License, or
|
||
|
(at your option) any later version.
|
||
|
|
||
|
This program is distributed in the hope that it will be useful,
|
||
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
GNU General Public License for more details.
|
||
|
|
||
|
You should have received a copy of the GNU General Public License
|
||
|
along with this program; if not, write to the Free Software
|
||
|
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||
|
*/
|
||
|
|
||
|
static int stb6100_get_freq(struct dvb_frontend *fe, u32 *frequency)
|
||
|
{
|
||
|
struct dvb_frontend_ops *frontend_ops = NULL;
|
||
|
struct dvb_tuner_ops *tuner_ops = NULL;
|
||
|
struct tuner_state state;
|
||
|
int err = 0;
|
||
|
|
||
|
if (&fe->ops)
|
||
|
frontend_ops = &fe->ops;
|
||
|
if (&frontend_ops->tuner_ops)
|
||
|
tuner_ops = &frontend_ops->tuner_ops;
|
||
|
if (tuner_ops->get_state) {
|
||
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
frontend_ops->i2c_gate_ctrl(fe, 1);
|
||
|
|
||
|
err = tuner_ops->get_state(fe, DVBFE_TUNER_FREQUENCY, &state);
|
||
|
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);
|
||
|
|
||
|
*frequency = state.frequency;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int stb6100_set_freq(struct dvb_frontend *fe, u32 frequency)
|
||
|
{
|
||
|
struct dvb_frontend_ops *frontend_ops = NULL;
|
||
|
struct dvb_tuner_ops *tuner_ops = NULL;
|
||
|
struct tuner_state state;
|
||
|
int err = 0;
|
||
|
|
||
|
state.frequency = frequency;
|
||
|
if (&fe->ops)
|
||
|
frontend_ops = &fe->ops;
|
||
|
if (&frontend_ops->tuner_ops)
|
||
|
tuner_ops = &frontend_ops->tuner_ops;
|
||
|
if (tuner_ops->set_state) {
|
||
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
frontend_ops->i2c_gate_ctrl(fe, 1);
|
||
|
|
||
|
err = tuner_ops->set_state(fe, DVBFE_TUNER_FREQUENCY, &state);
|
||
|
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_get_bandw(struct dvb_frontend *fe, u32 *bandwidth)
|
||
|
{
|
||
|
struct dvb_frontend_ops *frontend_ops = NULL;
|
||
|
struct dvb_tuner_ops *tuner_ops = NULL;
|
||
|
struct tuner_state state;
|
||
|
int err = 0;
|
||
|
|
||
|
if (&fe->ops)
|
||
|
frontend_ops = &fe->ops;
|
||
|
if (&frontend_ops->tuner_ops)
|
||
|
tuner_ops = &frontend_ops->tuner_ops;
|
||
|
if (tuner_ops->get_state) {
|
||
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
frontend_ops->i2c_gate_ctrl(fe, 1);
|
||
|
|
||
|
err = tuner_ops->get_state(fe, DVBFE_TUNER_BANDWIDTH, &state);
|
||
|
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);
|
||
|
|
||
|
*bandwidth = state.bandwidth;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int stb6100_set_bandw(struct dvb_frontend *fe, u32 bandwidth)
|
||
|
{
|
||
|
struct dvb_frontend_ops *frontend_ops = NULL;
|
||
|
struct dvb_tuner_ops *tuner_ops = NULL;
|
||
|
struct tuner_state state;
|
||
|
int err = 0;
|
||
|
|
||
|
state.bandwidth = bandwidth;
|
||
|
if (&fe->ops)
|
||
|
frontend_ops = &fe->ops;
|
||
|
if (&frontend_ops->tuner_ops)
|
||
|
tuner_ops = &frontend_ops->tuner_ops;
|
||
|
if (tuner_ops->set_state) {
|
||
|
if (frontend_ops->i2c_gate_ctrl)
|
||
|
frontend_ops->i2c_gate_ctrl(fe, 1);
|
||
|
|
||
|
err = tuner_ops->set_state(fe, DVBFE_TUNER_BANDWIDTH, &state);
|
||
|
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;
|
||
|
}
|