2009-11-17 04:22:32 +03:00
/*
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 0213 9 , USA .
*/
2015-11-11 23:42:00 +03:00
# include <linux/dvb/frontend.h>
# include "dvb_frontend.h"
2009-11-17 04:22:32 +03:00
static int stb6100_get_freq ( struct dvb_frontend * fe , u32 * frequency )
{
2014-06-25 01:42:27 +04:00
struct dvb_frontend_ops * frontend_ops = & fe - > ops ;
struct dvb_tuner_ops * tuner_ops = & frontend_ops - > tuner_ops ;
2009-11-17 04:22:32 +03:00
int err = 0 ;
2015-11-11 23:42:00 +03:00
if ( tuner_ops - > get_frequency ) {
2009-11-17 04:22:32 +03:00
if ( frontend_ops - > i2c_gate_ctrl )
frontend_ops - > i2c_gate_ctrl ( fe , 1 ) ;
2015-11-11 23:42:00 +03:00
err = tuner_ops - > get_frequency ( fe , frequency ) ;
2009-11-17 04:22:32 +03:00
if ( err < 0 ) {
2015-11-11 23:42:00 +03:00
printk ( " %s: Invalid parameter \n " , __func__ ) ;
2009-11-17 04:22:32 +03:00
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 )
{
2014-06-25 01:42:27 +04:00
struct dvb_frontend_ops * frontend_ops = & fe - > ops ;
struct dvb_tuner_ops * tuner_ops = & frontend_ops - > tuner_ops ;
2015-11-11 23:42:00 +03:00
struct dtv_frontend_properties * c = & fe - > dtv_property_cache ;
u32 bw = c - > bandwidth_hz ;
2009-11-17 04:22:32 +03:00
int err = 0 ;
2015-11-11 23:42:00 +03:00
c - > frequency = frequency ;
c - > bandwidth_hz = 0 ; /* Don't adjust the bandwidth */
2014-06-25 01:42:27 +04:00
2015-11-11 23:42:00 +03:00
if ( tuner_ops - > set_params ) {
2009-11-17 04:22:32 +03:00
if ( frontend_ops - > i2c_gate_ctrl )
frontend_ops - > i2c_gate_ctrl ( fe , 1 ) ;
2015-11-11 23:42:00 +03:00
err = tuner_ops - > set_params ( fe ) ;
c - > bandwidth_hz = bw ;
2009-11-17 04:22:32 +03:00
if ( err < 0 ) {
2015-11-11 23:42:00 +03:00
printk ( " %s: Invalid parameter \n " , __func__ ) ;
2009-11-17 04:22:32 +03:00
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 )
{
2014-06-25 01:42:27 +04:00
struct dvb_frontend_ops * frontend_ops = & fe - > ops ;
struct dvb_tuner_ops * tuner_ops = & frontend_ops - > tuner_ops ;
2009-11-17 04:22:32 +03:00
int err = 0 ;
2015-11-11 23:42:00 +03:00
if ( tuner_ops - > get_bandwidth ) {
2009-11-17 04:22:32 +03:00
if ( frontend_ops - > i2c_gate_ctrl )
frontend_ops - > i2c_gate_ctrl ( fe , 1 ) ;
2015-11-11 23:42:00 +03:00
err = tuner_ops - > get_bandwidth ( fe , bandwidth ) ;
2009-11-17 04:22:32 +03:00
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 )
{
2014-06-25 01:42:27 +04:00
struct dvb_frontend_ops * frontend_ops = & fe - > ops ;
struct dvb_tuner_ops * tuner_ops = & frontend_ops - > tuner_ops ;
2015-11-11 23:42:00 +03:00
struct dtv_frontend_properties * c = & fe - > dtv_property_cache ;
u32 freq = c - > frequency ;
2009-11-17 04:22:32 +03:00
int err = 0 ;
2015-11-11 23:42:00 +03:00
c - > bandwidth_hz = bandwidth ;
c - > frequency = 0 ; /* Don't adjust the frequency */
2014-06-25 01:42:27 +04:00
2015-11-11 23:42:00 +03:00
if ( tuner_ops - > set_params ) {
2009-11-17 04:22:32 +03:00
if ( frontend_ops - > i2c_gate_ctrl )
frontend_ops - > i2c_gate_ctrl ( fe , 1 ) ;
2015-11-11 23:42:00 +03:00
err = tuner_ops - > set_params ( fe ) ;
c - > frequency = freq ;
2009-11-17 04:22:32 +03:00
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 ;
}