Avoid beyond bounds copy while caching ACL
[zen-stable.git] / drivers / media / common / tuners / mt2131.c
blobf83b0c1ea6c86ad08e1f2252cde018077189d0db
1 /*
2 * Driver for Microtune MT2131 "QAM/8VSB single chip tuner"
4 * Copyright (c) 2006 Steven Toth <stoth@linuxtv.org>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 #include <linux/module.h>
23 #include <linux/delay.h>
24 #include <linux/dvb/frontend.h>
25 #include <linux/i2c.h>
26 #include <linux/slab.h>
28 #include "dvb_frontend.h"
30 #include "mt2131.h"
31 #include "mt2131_priv.h"
33 static int debug;
34 module_param(debug, int, 0644);
35 MODULE_PARM_DESC(debug, "Turn on/off debugging (default:off).");
37 #define dprintk(level,fmt, arg...) if (debug >= level) \
38 printk(KERN_INFO "%s: " fmt, "mt2131", ## arg)
40 static u8 mt2131_config1[] = {
41 0x01,
42 0x50, 0x00, 0x50, 0x80, 0x00, 0x49, 0xfa, 0x88,
43 0x08, 0x77, 0x41, 0x04, 0x00, 0x00, 0x00, 0x32,
44 0x7f, 0xda, 0x4c, 0x00, 0x10, 0xaa, 0x78, 0x80,
45 0xff, 0x68, 0xa0, 0xff, 0xdd, 0x00, 0x00
48 static u8 mt2131_config2[] = {
49 0x10,
50 0x7f, 0xc8, 0x0a, 0x5f, 0x00, 0x04
53 static int mt2131_readreg(struct mt2131_priv *priv, u8 reg, u8 *val)
55 struct i2c_msg msg[2] = {
56 { .addr = priv->cfg->i2c_address, .flags = 0,
57 .buf = &reg, .len = 1 },
58 { .addr = priv->cfg->i2c_address, .flags = I2C_M_RD,
59 .buf = val, .len = 1 },
62 if (i2c_transfer(priv->i2c, msg, 2) != 2) {
63 printk(KERN_WARNING "mt2131 I2C read failed\n");
64 return -EREMOTEIO;
66 return 0;
69 static int mt2131_writereg(struct mt2131_priv *priv, u8 reg, u8 val)
71 u8 buf[2] = { reg, val };
72 struct i2c_msg msg = { .addr = priv->cfg->i2c_address, .flags = 0,
73 .buf = buf, .len = 2 };
75 if (i2c_transfer(priv->i2c, &msg, 1) != 1) {
76 printk(KERN_WARNING "mt2131 I2C write failed\n");
77 return -EREMOTEIO;
79 return 0;
82 static int mt2131_writeregs(struct mt2131_priv *priv,u8 *buf, u8 len)
84 struct i2c_msg msg = { .addr = priv->cfg->i2c_address,
85 .flags = 0, .buf = buf, .len = len };
87 if (i2c_transfer(priv->i2c, &msg, 1) != 1) {
88 printk(KERN_WARNING "mt2131 I2C write failed (len=%i)\n",
89 (int)len);
90 return -EREMOTEIO;
92 return 0;
95 static int mt2131_set_params(struct dvb_frontend *fe)
97 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
98 struct mt2131_priv *priv;
99 int ret=0, i;
100 u32 freq;
101 u8 if_band_center;
102 u32 f_lo1, f_lo2;
103 u32 div1, num1, div2, num2;
104 u8 b[8];
105 u8 lockval = 0;
107 priv = fe->tuner_priv;
109 freq = c->frequency / 1000; /* Hz -> kHz */
110 dprintk(1, "%s() freq=%d\n", __func__, freq);
112 f_lo1 = freq + MT2131_IF1 * 1000;
113 f_lo1 = (f_lo1 / 250) * 250;
114 f_lo2 = f_lo1 - freq - MT2131_IF2;
116 priv->frequency = (f_lo1 - f_lo2 - MT2131_IF2) * 1000;
118 /* Frequency LO1 = 16MHz * (DIV1 + NUM1/8192 ) */
119 num1 = f_lo1 * 64 / (MT2131_FREF / 128);
120 div1 = num1 / 8192;
121 num1 &= 0x1fff;
123 /* Frequency LO2 = 16MHz * (DIV2 + NUM2/8192 ) */
124 num2 = f_lo2 * 64 / (MT2131_FREF / 128);
125 div2 = num2 / 8192;
126 num2 &= 0x1fff;
128 if (freq <= 82500) if_band_center = 0x00; else
129 if (freq <= 137500) if_band_center = 0x01; else
130 if (freq <= 192500) if_band_center = 0x02; else
131 if (freq <= 247500) if_band_center = 0x03; else
132 if (freq <= 302500) if_band_center = 0x04; else
133 if (freq <= 357500) if_band_center = 0x05; else
134 if (freq <= 412500) if_band_center = 0x06; else
135 if (freq <= 467500) if_band_center = 0x07; else
136 if (freq <= 522500) if_band_center = 0x08; else
137 if (freq <= 577500) if_band_center = 0x09; else
138 if (freq <= 632500) if_band_center = 0x0A; else
139 if (freq <= 687500) if_band_center = 0x0B; else
140 if (freq <= 742500) if_band_center = 0x0C; else
141 if (freq <= 797500) if_band_center = 0x0D; else
142 if (freq <= 852500) if_band_center = 0x0E; else
143 if (freq <= 907500) if_band_center = 0x0F; else
144 if (freq <= 962500) if_band_center = 0x10; else
145 if (freq <= 1017500) if_band_center = 0x11; else
146 if (freq <= 1072500) if_band_center = 0x12; else if_band_center = 0x13;
148 b[0] = 1;
149 b[1] = (num1 >> 5) & 0xFF;
150 b[2] = (num1 & 0x1F);
151 b[3] = div1;
152 b[4] = (num2 >> 5) & 0xFF;
153 b[5] = num2 & 0x1F;
154 b[6] = div2;
156 dprintk(1, "IF1: %dMHz IF2: %dMHz\n", MT2131_IF1, MT2131_IF2);
157 dprintk(1, "PLL freq=%dkHz band=%d\n", (int)freq, (int)if_band_center);
158 dprintk(1, "PLL f_lo1=%dkHz f_lo2=%dkHz\n", (int)f_lo1, (int)f_lo2);
159 dprintk(1, "PLL div1=%d num1=%d div2=%d num2=%d\n",
160 (int)div1, (int)num1, (int)div2, (int)num2);
161 dprintk(1, "PLL [1..6]: %2x %2x %2x %2x %2x %2x\n",
162 (int)b[1], (int)b[2], (int)b[3], (int)b[4], (int)b[5],
163 (int)b[6]);
165 ret = mt2131_writeregs(priv,b,7);
166 if (ret < 0)
167 return ret;
169 mt2131_writereg(priv, 0x0b, if_band_center);
171 /* Wait for lock */
172 i = 0;
173 do {
174 mt2131_readreg(priv, 0x08, &lockval);
175 if ((lockval & 0x88) == 0x88)
176 break;
177 msleep(4);
178 i++;
179 } while (i < 10);
181 return ret;
184 static int mt2131_get_frequency(struct dvb_frontend *fe, u32 *frequency)
186 struct mt2131_priv *priv = fe->tuner_priv;
187 dprintk(1, "%s()\n", __func__);
188 *frequency = priv->frequency;
189 return 0;
192 static int mt2131_get_status(struct dvb_frontend *fe, u32 *status)
194 struct mt2131_priv *priv = fe->tuner_priv;
195 u8 lock_status = 0;
196 u8 afc_status = 0;
198 *status = 0;
200 mt2131_readreg(priv, 0x08, &lock_status);
201 if ((lock_status & 0x88) == 0x88)
202 *status = TUNER_STATUS_LOCKED;
204 mt2131_readreg(priv, 0x09, &afc_status);
205 dprintk(1, "%s() - LO Status = 0x%x, AFC Status = 0x%x\n",
206 __func__, lock_status, afc_status);
208 return 0;
211 static int mt2131_init(struct dvb_frontend *fe)
213 struct mt2131_priv *priv = fe->tuner_priv;
214 int ret;
215 dprintk(1, "%s()\n", __func__);
217 if ((ret = mt2131_writeregs(priv, mt2131_config1,
218 sizeof(mt2131_config1))) < 0)
219 return ret;
221 mt2131_writereg(priv, 0x0b, 0x09);
222 mt2131_writereg(priv, 0x15, 0x47);
223 mt2131_writereg(priv, 0x07, 0xf2);
224 mt2131_writereg(priv, 0x0b, 0x01);
226 if ((ret = mt2131_writeregs(priv, mt2131_config2,
227 sizeof(mt2131_config2))) < 0)
228 return ret;
230 return ret;
233 static int mt2131_release(struct dvb_frontend *fe)
235 dprintk(1, "%s()\n", __func__);
236 kfree(fe->tuner_priv);
237 fe->tuner_priv = NULL;
238 return 0;
241 static const struct dvb_tuner_ops mt2131_tuner_ops = {
242 .info = {
243 .name = "Microtune MT2131",
244 .frequency_min = 48000000,
245 .frequency_max = 860000000,
246 .frequency_step = 50000,
249 .release = mt2131_release,
250 .init = mt2131_init,
252 .set_params = mt2131_set_params,
253 .get_frequency = mt2131_get_frequency,
254 .get_status = mt2131_get_status
257 struct dvb_frontend * mt2131_attach(struct dvb_frontend *fe,
258 struct i2c_adapter *i2c,
259 struct mt2131_config *cfg, u16 if1)
261 struct mt2131_priv *priv = NULL;
262 u8 id = 0;
264 dprintk(1, "%s()\n", __func__);
266 priv = kzalloc(sizeof(struct mt2131_priv), GFP_KERNEL);
267 if (priv == NULL)
268 return NULL;
270 priv->cfg = cfg;
271 priv->i2c = i2c;
273 if (mt2131_readreg(priv, 0, &id) != 0) {
274 kfree(priv);
275 return NULL;
277 if ( (id != 0x3E) && (id != 0x3F) ) {
278 printk(KERN_ERR "MT2131: Device not found at addr 0x%02x\n",
279 cfg->i2c_address);
280 kfree(priv);
281 return NULL;
284 printk(KERN_INFO "MT2131: successfully identified at address 0x%02x\n",
285 cfg->i2c_address);
286 memcpy(&fe->ops.tuner_ops, &mt2131_tuner_ops,
287 sizeof(struct dvb_tuner_ops));
289 fe->tuner_priv = priv;
290 return fe;
292 EXPORT_SYMBOL(mt2131_attach);
294 MODULE_AUTHOR("Steven Toth");
295 MODULE_DESCRIPTION("Microtune MT2131 silicon tuner driver");
296 MODULE_LICENSE("GPL");
299 * Local variables:
300 * c-basic-offset: 8