128 lines
		
	
	
		
			3.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			128 lines
		
	
	
		
			3.3 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.
 | |
| */
 | |
| 
 | |
| #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;
 | |
| }
 | 
