iwlwifi: introduce host commands callbacks
[linux/fpc-iii.git] / drivers / media / video / tea5767.c
blobe1b48d87e7b74fba277b9796e074bf13b514bd86
1 /*
2 * For Philips TEA5767 FM Chip used on some TV Cards like Prolink Pixelview
3 * I2C address is allways 0xC0.
6 * Copyright (c) 2005 Mauro Carvalho Chehab (mchehab@infradead.org)
7 * This code is placed under the terms of the GNU General Public License
9 * tea5767 autodetection thanks to Torsten Seeboth and Atsushi Nakagawa
10 * from their contributions on DScaler.
13 #include <linux/i2c.h>
14 #include <linux/delay.h>
15 #include <linux/videodev.h>
16 #include "tuner-i2c.h"
17 #include "tea5767.h"
19 static int debug = 0;
20 module_param(debug, int, 0644);
21 MODULE_PARM_DESC(debug, "enable verbose debug messages");
23 #define PREFIX "tea5767"
25 /*****************************************************************************/
27 struct tea5767_priv {
28 struct tuner_i2c_props i2c_props;
29 u32 frequency;
30 struct tea5767_ctrl ctrl;
33 /*****************************************************************************/
35 /******************************
36 * Write mode register values *
37 ******************************/
39 /* First register */
40 #define TEA5767_MUTE 0x80 /* Mutes output */
41 #define TEA5767_SEARCH 0x40 /* Activates station search */
42 /* Bits 0-5 for divider MSB */
44 /* Second register */
45 /* Bits 0-7 for divider LSB */
47 /* Third register */
49 /* Station search from botton to up */
50 #define TEA5767_SEARCH_UP 0x80
52 /* Searches with ADC output = 10 */
53 #define TEA5767_SRCH_HIGH_LVL 0x60
55 /* Searches with ADC output = 10 */
56 #define TEA5767_SRCH_MID_LVL 0x40
58 /* Searches with ADC output = 5 */
59 #define TEA5767_SRCH_LOW_LVL 0x20
61 /* if on, div=4*(Frf+Fif)/Fref otherwise, div=4*(Frf-Fif)/Freq) */
62 #define TEA5767_HIGH_LO_INJECT 0x10
64 /* Disable stereo */
65 #define TEA5767_MONO 0x08
67 /* Disable right channel and turns to mono */
68 #define TEA5767_MUTE_RIGHT 0x04
70 /* Disable left channel and turns to mono */
71 #define TEA5767_MUTE_LEFT 0x02
73 #define TEA5767_PORT1_HIGH 0x01
75 /* Fourth register */
76 #define TEA5767_PORT2_HIGH 0x80
77 /* Chips stops working. Only I2C bus remains on */
78 #define TEA5767_STDBY 0x40
80 /* Japan freq (76-108 MHz. If disabled, 87.5-108 MHz */
81 #define TEA5767_JAPAN_BAND 0x20
83 /* Unselected means 32.768 KHz freq as reference. Otherwise Xtal at 13 MHz */
84 #define TEA5767_XTAL_32768 0x10
86 /* Cuts weak signals */
87 #define TEA5767_SOFT_MUTE 0x08
89 /* Activates high cut control */
90 #define TEA5767_HIGH_CUT_CTRL 0x04
92 /* Activates stereo noise control */
93 #define TEA5767_ST_NOISE_CTL 0x02
95 /* If activate PORT 1 indicates SEARCH or else it is used as PORT1 */
96 #define TEA5767_SRCH_IND 0x01
98 /* Fifth register */
100 /* By activating, it will use Xtal at 13 MHz as reference for divider */
101 #define TEA5767_PLLREF_ENABLE 0x80
103 /* By activating, deemphasis=50, or else, deemphasis of 50us */
104 #define TEA5767_DEEMPH_75 0X40
106 /*****************************
107 * Read mode register values *
108 *****************************/
110 /* First register */
111 #define TEA5767_READY_FLAG_MASK 0x80
112 #define TEA5767_BAND_LIMIT_MASK 0X40
113 /* Bits 0-5 for divider MSB after search or preset */
115 /* Second register */
116 /* Bits 0-7 for divider LSB after search or preset */
118 /* Third register */
119 #define TEA5767_STEREO_MASK 0x80
120 #define TEA5767_IF_CNTR_MASK 0x7f
122 /* Fourth register */
123 #define TEA5767_ADC_LEVEL_MASK 0xf0
125 /* should be 0 */
126 #define TEA5767_CHIP_ID_MASK 0x0f
128 /* Fifth register */
129 /* Reserved for future extensions */
130 #define TEA5767_RESERVED_MASK 0xff
132 /*****************************************************************************/
134 static void tea5767_status_dump(struct tea5767_priv *priv,
135 unsigned char *buffer)
137 unsigned int div, frq;
139 if (TEA5767_READY_FLAG_MASK & buffer[0])
140 printk(PREFIX "Ready Flag ON\n");
141 else
142 printk(PREFIX "Ready Flag OFF\n");
144 if (TEA5767_BAND_LIMIT_MASK & buffer[0])
145 printk(PREFIX "Tuner at band limit\n");
146 else
147 printk(PREFIX "Tuner not at band limit\n");
149 div = ((buffer[0] & 0x3f) << 8) | buffer[1];
151 switch (priv->ctrl.xtal_freq) {
152 case TEA5767_HIGH_LO_13MHz:
153 frq = (div * 50000 - 700000 - 225000) / 4; /* Freq in KHz */
154 break;
155 case TEA5767_LOW_LO_13MHz:
156 frq = (div * 50000 + 700000 + 225000) / 4; /* Freq in KHz */
157 break;
158 case TEA5767_LOW_LO_32768:
159 frq = (div * 32768 + 700000 + 225000) / 4; /* Freq in KHz */
160 break;
161 case TEA5767_HIGH_LO_32768:
162 default:
163 frq = (div * 32768 - 700000 - 225000) / 4; /* Freq in KHz */
164 break;
166 buffer[0] = (div >> 8) & 0x3f;
167 buffer[1] = div & 0xff;
169 printk(PREFIX "Frequency %d.%03d KHz (divider = 0x%04x)\n",
170 frq / 1000, frq % 1000, div);
172 if (TEA5767_STEREO_MASK & buffer[2])
173 printk(PREFIX "Stereo\n");
174 else
175 printk(PREFIX "Mono\n");
177 printk(PREFIX "IF Counter = %d\n", buffer[2] & TEA5767_IF_CNTR_MASK);
179 printk(PREFIX "ADC Level = %d\n",
180 (buffer[3] & TEA5767_ADC_LEVEL_MASK) >> 4);
182 printk(PREFIX "Chip ID = %d\n", (buffer[3] & TEA5767_CHIP_ID_MASK));
184 printk(PREFIX "Reserved = 0x%02x\n",
185 (buffer[4] & TEA5767_RESERVED_MASK));
188 /* Freq should be specifyed at 62.5 Hz */
189 static int set_radio_freq(struct dvb_frontend *fe,
190 struct analog_parameters *params)
192 struct tea5767_priv *priv = fe->tuner_priv;
193 unsigned int frq = params->frequency;
194 unsigned char buffer[5];
195 unsigned div;
196 int rc;
198 tuner_dbg("radio freq = %d.%03d MHz\n", frq/16000,(frq/16)%1000);
200 buffer[2] = 0;
202 if (priv->ctrl.port1)
203 buffer[2] |= TEA5767_PORT1_HIGH;
205 if (params->audmode == V4L2_TUNER_MODE_MONO) {
206 tuner_dbg("TEA5767 set to mono\n");
207 buffer[2] |= TEA5767_MONO;
208 } else {
209 tuner_dbg("TEA5767 set to stereo\n");
213 buffer[3] = 0;
215 if (priv->ctrl.port2)
216 buffer[3] |= TEA5767_PORT2_HIGH;
218 if (priv->ctrl.high_cut)
219 buffer[3] |= TEA5767_HIGH_CUT_CTRL;
221 if (priv->ctrl.st_noise)
222 buffer[3] |= TEA5767_ST_NOISE_CTL;
224 if (priv->ctrl.soft_mute)
225 buffer[3] |= TEA5767_SOFT_MUTE;
227 if (priv->ctrl.japan_band)
228 buffer[3] |= TEA5767_JAPAN_BAND;
230 buffer[4] = 0;
232 if (priv->ctrl.deemph_75)
233 buffer[4] |= TEA5767_DEEMPH_75;
235 if (priv->ctrl.pllref)
236 buffer[4] |= TEA5767_PLLREF_ENABLE;
239 /* Rounds freq to next decimal value - for 62.5 KHz step */
240 /* frq = 20*(frq/16)+radio_frq[frq%16]; */
242 switch (priv->ctrl.xtal_freq) {
243 case TEA5767_HIGH_LO_13MHz:
244 tuner_dbg("radio HIGH LO inject xtal @ 13 MHz\n");
245 buffer[2] |= TEA5767_HIGH_LO_INJECT;
246 div = (frq * (4000 / 16) + 700000 + 225000 + 25000) / 50000;
247 break;
248 case TEA5767_LOW_LO_13MHz:
249 tuner_dbg("radio LOW LO inject xtal @ 13 MHz\n");
251 div = (frq * (4000 / 16) - 700000 - 225000 + 25000) / 50000;
252 break;
253 case TEA5767_LOW_LO_32768:
254 tuner_dbg("radio LOW LO inject xtal @ 32,768 MHz\n");
255 buffer[3] |= TEA5767_XTAL_32768;
256 /* const 700=4000*175 Khz - to adjust freq to right value */
257 div = ((frq * (4000 / 16) - 700000 - 225000) + 16384) >> 15;
258 break;
259 case TEA5767_HIGH_LO_32768:
260 default:
261 tuner_dbg("radio HIGH LO inject xtal @ 32,768 MHz\n");
263 buffer[2] |= TEA5767_HIGH_LO_INJECT;
264 buffer[3] |= TEA5767_XTAL_32768;
265 div = ((frq * (4000 / 16) + 700000 + 225000) + 16384) >> 15;
266 break;
268 buffer[0] = (div >> 8) & 0x3f;
269 buffer[1] = div & 0xff;
271 if (5 != (rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 5)))
272 tuner_warn("i2c i/o error: rc == %d (should be 5)\n", rc);
274 if (debug) {
275 if (5 != (rc = tuner_i2c_xfer_recv(&priv->i2c_props, buffer, 5)))
276 tuner_warn("i2c i/o error: rc == %d (should be 5)\n", rc);
277 else
278 tea5767_status_dump(priv, buffer);
281 priv->frequency = frq * 125 / 2;
283 return 0;
286 static int tea5767_read_status(struct dvb_frontend *fe, char *buffer)
288 struct tea5767_priv *priv = fe->tuner_priv;
289 int rc;
291 memset(buffer, 0, 5);
292 if (5 != (rc = tuner_i2c_xfer_recv(&priv->i2c_props, buffer, 5))) {
293 tuner_warn("i2c i/o error: rc == %d (should be 5)\n", rc);
294 return -EREMOTEIO;
297 return 0;
300 static inline int tea5767_signal(struct dvb_frontend *fe, const char *buffer)
302 struct tea5767_priv *priv = fe->tuner_priv;
304 int signal = ((buffer[3] & TEA5767_ADC_LEVEL_MASK) << 8);
306 tuner_dbg("Signal strength: %d\n", signal);
308 return signal;
311 static inline int tea5767_stereo(struct dvb_frontend *fe, const char *buffer)
313 struct tea5767_priv *priv = fe->tuner_priv;
315 int stereo = buffer[2] & TEA5767_STEREO_MASK;
317 tuner_dbg("Radio ST GET = %02x\n", stereo);
319 return (stereo ? V4L2_TUNER_SUB_STEREO : 0);
322 static int tea5767_get_status(struct dvb_frontend *fe, u32 *status)
324 unsigned char buffer[5];
326 *status = 0;
328 if (0 == tea5767_read_status(fe, buffer)) {
329 if (tea5767_signal(fe, buffer))
330 *status = TUNER_STATUS_LOCKED;
331 if (tea5767_stereo(fe, buffer))
332 *status |= TUNER_STATUS_STEREO;
335 return 0;
338 static int tea5767_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
340 unsigned char buffer[5];
342 *strength = 0;
344 if (0 == tea5767_read_status(fe, buffer))
345 *strength = tea5767_signal(fe, buffer);
347 return 0;
350 static int tea5767_standby(struct dvb_frontend *fe)
352 unsigned char buffer[5];
353 struct tea5767_priv *priv = fe->tuner_priv;
354 unsigned div, rc;
356 div = (87500 * 4 + 700 + 225 + 25) / 50; /* Set frequency to 87.5 MHz */
357 buffer[0] = (div >> 8) & 0x3f;
358 buffer[1] = div & 0xff;
359 buffer[2] = TEA5767_PORT1_HIGH;
360 buffer[3] = TEA5767_PORT2_HIGH | TEA5767_HIGH_CUT_CTRL |
361 TEA5767_ST_NOISE_CTL | TEA5767_JAPAN_BAND | TEA5767_STDBY;
362 buffer[4] = 0;
364 if (5 != (rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 5)))
365 tuner_warn("i2c i/o error: rc == %d (should be 5)\n", rc);
367 return 0;
370 int tea5767_autodetection(struct i2c_adapter* i2c_adap, u8 i2c_addr)
372 struct tuner_i2c_props i2c = { .adap = i2c_adap, .addr = i2c_addr };
373 unsigned char buffer[7] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
374 int rc;
376 if ((rc = tuner_i2c_xfer_recv(&i2c, buffer, 7))< 5) {
377 printk(KERN_WARNING "It is not a TEA5767. Received %i bytes.\n", rc);
378 return EINVAL;
381 /* If all bytes are the same then it's a TV tuner and not a tea5767 */
382 if (buffer[0] == buffer[1] && buffer[0] == buffer[2] &&
383 buffer[0] == buffer[3] && buffer[0] == buffer[4]) {
384 printk(KERN_WARNING "All bytes are equal. It is not a TEA5767\n");
385 return EINVAL;
388 /* Status bytes:
389 * Byte 4: bit 3:1 : CI (Chip Identification) == 0
390 * bit 0 : internally set to 0
391 * Byte 5: bit 7:0 : == 0
393 if (((buffer[3] & 0x0f) != 0x00) || (buffer[4] != 0x00)) {
394 printk(KERN_WARNING "Chip ID is not zero. It is not a TEA5767\n");
395 return EINVAL;
398 /* It seems that tea5767 returns 0xff after the 5th byte */
399 if ((buffer[5] != 0xff) || (buffer[6] != 0xff)) {
400 printk(KERN_WARNING "Returned more than 5 bytes. It is not a TEA5767\n");
401 return EINVAL;
404 return 0;
407 static int tea5767_release(struct dvb_frontend *fe)
409 kfree(fe->tuner_priv);
410 fe->tuner_priv = NULL;
412 return 0;
415 static int tea5767_get_frequency(struct dvb_frontend *fe, u32 *frequency)
417 struct tea5767_priv *priv = fe->tuner_priv;
418 *frequency = priv->frequency;
420 return 0;
423 static int tea5767_set_config (struct dvb_frontend *fe, void *priv_cfg)
425 struct tea5767_priv *priv = fe->tuner_priv;
427 memcpy(&priv->ctrl, priv_cfg, sizeof(priv->ctrl));
429 return 0;
432 static struct dvb_tuner_ops tea5767_tuner_ops = {
433 .info = {
434 .name = "tea5767", // Philips TEA5767HN FM Radio
437 .set_analog_params = set_radio_freq,
438 .set_config = tea5767_set_config,
439 .sleep = tea5767_standby,
440 .release = tea5767_release,
441 .get_frequency = tea5767_get_frequency,
442 .get_status = tea5767_get_status,
443 .get_rf_strength = tea5767_get_rf_strength,
446 struct dvb_frontend *tea5767_attach(struct dvb_frontend *fe,
447 struct i2c_adapter* i2c_adap,
448 u8 i2c_addr)
450 struct tea5767_priv *priv = NULL;
452 priv = kzalloc(sizeof(struct tea5767_priv), GFP_KERNEL);
453 if (priv == NULL)
454 return NULL;
455 fe->tuner_priv = priv;
457 priv->i2c_props.addr = i2c_addr;
458 priv->i2c_props.adap = i2c_adap;
459 priv->ctrl.xtal_freq = TEA5767_HIGH_LO_32768;
460 priv->ctrl.port1 = 1;
461 priv->ctrl.port2 = 1;
462 priv->ctrl.high_cut = 1;
463 priv->ctrl.st_noise = 1;
464 priv->ctrl.japan_band = 1;
466 memcpy(&fe->ops.tuner_ops, &tea5767_tuner_ops,
467 sizeof(struct dvb_tuner_ops));
469 tuner_info("type set to %s\n", "Philips TEA5767HN FM Radio");
471 return fe;
474 EXPORT_SYMBOL_GPL(tea5767_attach);
475 EXPORT_SYMBOL_GPL(tea5767_autodetection);
477 MODULE_DESCRIPTION("Philips TEA5767 FM tuner driver");
478 MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@infradead.org>");
479 MODULE_LICENSE("GPL");