Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
1da177e4 LT |
2 | * i2c tv tuner chip device driver |
3 | * core core, i.e. kernel interfaces, registering and so on | |
a2894e3f MCC |
4 | * |
5 | * Copyright(c) by Ralph Metzler, Gerd Knorr, Gunther Mayer | |
6 | * | |
7 | * Copyright(c) 2005-2011 by Mauro Carvalho Chehab | |
8 | * - Added support for a separate Radio tuner | |
9 | * - Major rework and cleanups at the code | |
10 | * | |
11 | * This driver supports many devices and the idea is to let the driver | |
12 | * detect which device is present. So rather than listing all supported | |
13 | * devices here, we pretend to support a single, fake device type that will | |
14 | * handle both radio and analog TV tuning. | |
1da177e4 LT |
15 | */ |
16 | ||
17 | #include <linux/module.h> | |
1da177e4 | 18 | #include <linux/kernel.h> |
1da177e4 LT |
19 | #include <linux/string.h> |
20 | #include <linux/timer.h> | |
21 | #include <linux/delay.h> | |
22 | #include <linux/errno.h> | |
23 | #include <linux/slab.h> | |
24 | #include <linux/poll.h> | |
25 | #include <linux/i2c.h> | |
26 | #include <linux/types.h> | |
1da177e4 | 27 | #include <linux/init.h> |
75b4c260 | 28 | #include <linux/videodev2.h> |
1da177e4 | 29 | #include <media/tuner.h> |
4adad287 | 30 | #include <media/tuner-types.h> |
e8a4a9e7 | 31 | #include <media/v4l2-device.h> |
35ea11ff | 32 | #include <media/v4l2-ioctl.h> |
96c0b7cf | 33 | #include "mt20xx.h" |
910bb3e3 | 34 | #include "tda8290.h" |
7ab10bf7 | 35 | #include "tea5761.h" |
8d0936ed | 36 | #include "tea5767.h" |
215b95ba | 37 | #include "tuner-xc2028.h" |
4adad287 | 38 | #include "tuner-simple.h" |
31c9584c | 39 | #include "tda9887.h" |
27c685a4 | 40 | #include "xc5000.h" |
93463895 | 41 | #include "tda18271.h" |
1da177e4 LT |
42 | |
43 | #define UNSET (-1U) | |
44 | ||
7d275bf8 | 45 | #define PREFIX (t->i2c->driver->driver.name) |
241020d1 | 46 | |
9f3f71ef MCC |
47 | /* |
48 | * Driver modprobe parameters | |
49 | */ | |
50 | ||
51 | /* insmod options used at init time => read/only */ | |
52 | static unsigned int addr; | |
53 | static unsigned int no_autodetect; | |
54 | static unsigned int show_i2c; | |
55 | ||
56 | module_param(addr, int, 0444); | |
57 | module_param(no_autodetect, int, 0444); | |
58 | module_param(show_i2c, int, 0444); | |
59 | ||
60 | /* insmod options used at runtime => read/write */ | |
61 | static int tuner_debug; | |
62 | static unsigned int tv_range[2] = { 44, 958 }; | |
63 | static unsigned int radio_range[2] = { 65, 108 }; | |
64 | static char pal[] = "--"; | |
65 | static char secam[] = "--"; | |
66 | static char ntsc[] = "-"; | |
67 | ||
7d275bf8 | 68 | module_param_named(debug, tuner_debug, int, 0644); |
9f3f71ef MCC |
69 | module_param_array(tv_range, int, NULL, 0644); |
70 | module_param_array(radio_range, int, NULL, 0644); | |
71 | module_param_string(pal, pal, sizeof(pal), 0644); | |
72 | module_param_string(secam, secam, sizeof(secam), 0644); | |
73 | module_param_string(ntsc, ntsc, sizeof(ntsc), 0644); | |
74 | ||
75 | /* | |
76 | * Static vars | |
77 | */ | |
78 | ||
9f3f71ef | 79 | static LIST_HEAD(tuner_list); |
a2894e3f | 80 | static const struct v4l2_subdev_ops tuner_ops; |
9f3f71ef MCC |
81 | |
82 | /* | |
83 | * Debug macros | |
84 | */ | |
85 | ||
86 | #define tuner_warn(fmt, arg...) do { \ | |
87 | printk(KERN_WARNING "%s %d-%04x: " fmt, PREFIX, \ | |
88 | i2c_adapter_id(t->i2c->adapter), \ | |
89 | t->i2c->addr, ##arg); \ | |
90 | } while (0) | |
91 | ||
92 | #define tuner_info(fmt, arg...) do { \ | |
93 | printk(KERN_INFO "%s %d-%04x: " fmt, PREFIX, \ | |
94 | i2c_adapter_id(t->i2c->adapter), \ | |
95 | t->i2c->addr, ##arg); \ | |
96 | } while (0) | |
97 | ||
98 | #define tuner_err(fmt, arg...) do { \ | |
99 | printk(KERN_ERR "%s %d-%04x: " fmt, PREFIX, \ | |
100 | i2c_adapter_id(t->i2c->adapter), \ | |
101 | t->i2c->addr, ##arg); \ | |
102 | } while (0) | |
103 | ||
104 | #define tuner_dbg(fmt, arg...) do { \ | |
105 | if (tuner_debug) \ | |
106 | printk(KERN_DEBUG "%s %d-%04x: " fmt, PREFIX, \ | |
107 | i2c_adapter_id(t->i2c->adapter), \ | |
108 | t->i2c->addr, ##arg); \ | |
109 | } while (0) | |
110 | ||
111 | /* | |
112 | * Internal struct used inside the driver | |
113 | */ | |
114 | ||
115 | struct tuner { | |
116 | /* device */ | |
117 | struct dvb_frontend fe; | |
118 | struct i2c_client *i2c; | |
119 | struct v4l2_subdev sd; | |
120 | struct list_head list; | |
121 | ||
122 | /* keep track of the current settings */ | |
123 | v4l2_std_id std; | |
124 | unsigned int tv_freq; | |
125 | unsigned int radio_freq; | |
126 | unsigned int audmode; | |
127 | ||
cbde6898 | 128 | enum v4l2_tuner_type mode; |
9f3f71ef MCC |
129 | unsigned int mode_mask; /* Combination of allowable modes */ |
130 | ||
cbde6898 MCC |
131 | bool standby; /* Standby mode */ |
132 | ||
9f3f71ef MCC |
133 | unsigned int type; /* chip type id */ |
134 | unsigned int config; | |
135 | const char *name; | |
136 | }; | |
137 | ||
a2894e3f MCC |
138 | /* |
139 | * Function prototypes | |
140 | */ | |
141 | ||
142 | static void set_tv_freq(struct i2c_client *c, unsigned int freq); | |
143 | static void set_radio_freq(struct i2c_client *c, unsigned int freq); | |
144 | ||
9f3f71ef MCC |
145 | /* |
146 | * tuner attach/detach logic | |
147 | */ | |
148 | ||
0ae79d99 | 149 | /* This macro allows us to probe dynamically, avoiding static links */ |
ff138171 | 150 | #ifdef CONFIG_MEDIA_ATTACH |
a07c8779 MK |
151 | #define tuner_symbol_probe(FUNCTION, ARGS...) ({ \ |
152 | int __r = -EINVAL; \ | |
153 | typeof(&FUNCTION) __a = symbol_request(FUNCTION); \ | |
154 | if (__a) { \ | |
155 | __r = (int) __a(ARGS); \ | |
a1355e53 | 156 | symbol_put(FUNCTION); \ |
a07c8779 MK |
157 | } else { \ |
158 | printk(KERN_ERR "TUNER: Unable to find " \ | |
159 | "symbol "#FUNCTION"()\n"); \ | |
160 | } \ | |
a07c8779 MK |
161 | __r; \ |
162 | }) | |
163 | ||
164 | static void tuner_detach(struct dvb_frontend *fe) | |
165 | { | |
166 | if (fe->ops.tuner_ops.release) { | |
167 | fe->ops.tuner_ops.release(fe); | |
168 | symbol_put_addr(fe->ops.tuner_ops.release); | |
169 | } | |
170 | if (fe->ops.analog_ops.release) { | |
171 | fe->ops.analog_ops.release(fe); | |
172 | symbol_put_addr(fe->ops.analog_ops.release); | |
173 | } | |
174 | } | |
175 | #else | |
176 | #define tuner_symbol_probe(FUNCTION, ARGS...) ({ \ | |
177 | FUNCTION(ARGS); \ | |
178 | }) | |
179 | ||
180 | static void tuner_detach(struct dvb_frontend *fe) | |
181 | { | |
182 | if (fe->ops.tuner_ops.release) | |
183 | fe->ops.tuner_ops.release(fe); | |
184 | if (fe->ops.analog_ops.release) | |
185 | fe->ops.analog_ops.release(fe); | |
186 | } | |
187 | #endif | |
188 | ||
f7f427e4 | 189 | |
e8a4a9e7 HV |
190 | static inline struct tuner *to_tuner(struct v4l2_subdev *sd) |
191 | { | |
192 | return container_of(sd, struct tuner, sd); | |
193 | } | |
194 | ||
9f3f71ef MCC |
195 | /* |
196 | * struct analog_demod_ops callbacks | |
197 | */ | |
1da177e4 | 198 | |
c7919d52 MK |
199 | static void fe_set_params(struct dvb_frontend *fe, |
200 | struct analog_parameters *params) | |
e18f9444 | 201 | { |
4e9154b8 MK |
202 | struct dvb_tuner_ops *fe_tuner_ops = &fe->ops.tuner_ops; |
203 | struct tuner *t = fe->analog_demod_priv; | |
e18f9444 | 204 | |
e18f9444 MK |
205 | if (NULL == fe_tuner_ops->set_analog_params) { |
206 | tuner_warn("Tuner frontend module has no way to set freq\n"); | |
207 | return; | |
208 | } | |
c7919d52 | 209 | fe_tuner_ops->set_analog_params(fe, params); |
e18f9444 MK |
210 | } |
211 | ||
4e9154b8 | 212 | static void fe_standby(struct dvb_frontend *fe) |
e18f9444 | 213 | { |
4e9154b8 | 214 | struct dvb_tuner_ops *fe_tuner_ops = &fe->ops.tuner_ops; |
e18f9444 MK |
215 | |
216 | if (fe_tuner_ops->sleep) | |
4e9154b8 | 217 | fe_tuner_ops->sleep(fe); |
e18f9444 MK |
218 | } |
219 | ||
4e9154b8 | 220 | static int fe_has_signal(struct dvb_frontend *fe) |
1f5ef197 | 221 | { |
1419683d | 222 | u16 strength = 0; |
1f5ef197 | 223 | |
4e9154b8 MK |
224 | if (fe->ops.tuner_ops.get_rf_strength) |
225 | fe->ops.tuner_ops.get_rf_strength(fe, &strength); | |
1f5ef197 MK |
226 | |
227 | return strength; | |
228 | } | |
229 | ||
f1c9a281 MK |
230 | static int fe_set_config(struct dvb_frontend *fe, void *priv_cfg) |
231 | { | |
232 | struct dvb_tuner_ops *fe_tuner_ops = &fe->ops.tuner_ops; | |
233 | struct tuner *t = fe->analog_demod_priv; | |
234 | ||
235 | if (fe_tuner_ops->set_config) | |
236 | return fe_tuner_ops->set_config(fe, priv_cfg); | |
237 | ||
238 | tuner_warn("Tuner frontend module has no way to set config\n"); | |
239 | ||
240 | return 0; | |
241 | } | |
242 | ||
4e9154b8 | 243 | static void tuner_status(struct dvb_frontend *fe); |
1dde7a4f | 244 | |
e8a4a9e7 | 245 | static struct analog_demod_ops tuner_analog_ops = { |
c7919d52 | 246 | .set_params = fe_set_params, |
1dde7a4f | 247 | .standby = fe_standby, |
1dde7a4f | 248 | .has_signal = fe_has_signal, |
f1c9a281 | 249 | .set_config = fe_set_config, |
1dde7a4f MK |
250 | .tuner_status = tuner_status |
251 | }; | |
252 | ||
9f3f71ef | 253 | /* |
0eec66c0 | 254 | * Functions to select between radio and TV and tuner probe/remove functions |
9f3f71ef | 255 | */ |
1da177e4 | 256 | |
a2894e3f MCC |
257 | /** |
258 | * set_type - Sets the tuner type for a given device | |
259 | * | |
260 | * @c: i2c_client descriptoy | |
261 | * @type: type of the tuner (e. g. tuner number) | |
262 | * @new_mode_mask: Indicates if tuner supports TV and/or Radio | |
263 | * @new_config: an optional parameter ranging from 0-255 used by | |
264 | a few tuners to adjust an internal parameter, | |
265 | like LNA mode | |
266 | * @tuner_callback: an optional function to be called when switching | |
267 | * to analog mode | |
268 | * | |
269 | * This function applys the tuner config to tuner specified | |
270 | * by tun_setup structure. It contains several per-tuner initialization "magic" | |
271 | */ | |
f7ce3cc6 | 272 | static void set_type(struct i2c_client *c, unsigned int type, |
de956c1e | 273 | unsigned int new_mode_mask, unsigned int new_config, |
d7cba043 | 274 | int (*tuner_callback) (void *dev, int component, int cmd, int arg)) |
1da177e4 | 275 | { |
e8a4a9e7 | 276 | struct tuner *t = to_tuner(i2c_get_clientdata(c)); |
e18f9444 | 277 | struct dvb_tuner_ops *fe_tuner_ops = &t->fe.ops.tuner_ops; |
bc3e5c7f | 278 | struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops; |
586b0cab | 279 | unsigned char buffer[4]; |
d6eef494 | 280 | int tune_now = 1; |
1da177e4 | 281 | |
f7ce3cc6 | 282 | if (type == UNSET || type == TUNER_ABSENT) { |
7d275bf8 | 283 | tuner_dbg("tuner 0x%02x: Tuner type absent\n", c->addr); |
1da177e4 | 284 | return; |
f7ce3cc6 MCC |
285 | } |
286 | ||
80f90fba | 287 | t->type = type; |
e7ddcd98 | 288 | /* prevent invalid config values */ |
f14a2972 | 289 | t->config = new_config < 256 ? new_config : 0; |
80f90fba HH |
290 | if (tuner_callback != NULL) { |
291 | tuner_dbg("defining GPIO callback\n"); | |
d7cba043 | 292 | t->fe.callback = tuner_callback; |
80f90fba HH |
293 | } |
294 | ||
b2083199 | 295 | /* discard private data, in case set_type() was previously called */ |
a07c8779 MK |
296 | tuner_detach(&t->fe); |
297 | t->fe.analog_demod_priv = NULL; | |
be2b85a1 | 298 | |
1da177e4 LT |
299 | switch (t->type) { |
300 | case TUNER_MT2032: | |
09fee5f8 MCC |
301 | if (!dvb_attach(microtune_attach, |
302 | &t->fe, t->i2c->adapter, t->i2c->addr)) | |
303 | goto attach_failed; | |
1da177e4 LT |
304 | break; |
305 | case TUNER_PHILIPS_TDA8290: | |
5bea1cd3 | 306 | { |
09fee5f8 MCC |
307 | struct tda829x_config cfg = { |
308 | .lna_cfg = t->config, | |
09fee5f8 MCC |
309 | }; |
310 | if (!dvb_attach(tda829x_attach, &t->fe, t->i2c->adapter, | |
311 | t->i2c->addr, &cfg)) | |
312 | goto attach_failed; | |
5bea1cd3 MK |
313 | break; |
314 | } | |
586b0cab | 315 | case TUNER_TEA5767: |
a07c8779 MK |
316 | if (!dvb_attach(tea5767_attach, &t->fe, |
317 | t->i2c->adapter, t->i2c->addr)) | |
b9ef6bbb | 318 | goto attach_failed; |
f7ce3cc6 | 319 | t->mode_mask = T_RADIO; |
586b0cab | 320 | break; |
8573a9e6 | 321 | case TUNER_TEA5761: |
a07c8779 MK |
322 | if (!dvb_attach(tea5761_attach, &t->fe, |
323 | t->i2c->adapter, t->i2c->addr)) | |
b9ef6bbb | 324 | goto attach_failed; |
8573a9e6 MCC |
325 | t->mode_mask = T_RADIO; |
326 | break; | |
586b0cab MCC |
327 | case TUNER_PHILIPS_FMD1216ME_MK3: |
328 | buffer[0] = 0x0b; | |
329 | buffer[1] = 0xdc; | |
330 | buffer[2] = 0x9c; | |
331 | buffer[3] = 0x60; | |
f7ce3cc6 | 332 | i2c_master_send(c, buffer, 4); |
586b0cab MCC |
333 | mdelay(1); |
334 | buffer[2] = 0x86; | |
335 | buffer[3] = 0x54; | |
f7ce3cc6 | 336 | i2c_master_send(c, buffer, 4); |
a07c8779 MK |
337 | if (!dvb_attach(simple_tuner_attach, &t->fe, |
338 | t->i2c->adapter, t->i2c->addr, t->type)) | |
b9ef6bbb | 339 | goto attach_failed; |
586b0cab | 340 | break; |
93df3413 HH |
341 | case TUNER_PHILIPS_TD1316: |
342 | buffer[0] = 0x0b; | |
343 | buffer[1] = 0xdc; | |
344 | buffer[2] = 0x86; | |
345 | buffer[3] = 0xa4; | |
a07c8779 MK |
346 | i2c_master_send(c, buffer, 4); |
347 | if (!dvb_attach(simple_tuner_attach, &t->fe, | |
348 | t->i2c->adapter, t->i2c->addr, t->type)) | |
b9ef6bbb | 349 | goto attach_failed; |
ac272ed7 | 350 | break; |
690c544c MCC |
351 | case TUNER_XC2028: |
352 | { | |
a37b4c9b ML |
353 | struct xc2028_config cfg = { |
354 | .i2c_adap = t->i2c->adapter, | |
355 | .i2c_addr = t->i2c->addr, | |
a37b4c9b | 356 | }; |
a07c8779 | 357 | if (!dvb_attach(xc2028_attach, &t->fe, &cfg)) |
b9ef6bbb | 358 | goto attach_failed; |
d6eef494 | 359 | tune_now = 0; |
690c544c MCC |
360 | break; |
361 | } | |
15396236 | 362 | case TUNER_TDA9887: |
09fee5f8 MCC |
363 | if (!dvb_attach(tda9887_attach, |
364 | &t->fe, t->i2c->adapter, t->i2c->addr)) | |
365 | goto attach_failed; | |
15396236 | 366 | break; |
27c685a4 | 367 | case TUNER_XC5000: |
b9ef6bbb | 368 | { |
900f734b MCC |
369 | struct xc5000_config xc5000_cfg = { |
370 | .i2c_address = t->i2c->addr, | |
371 | /* if_khz will be set at dvb_attach() */ | |
372 | .if_khz = 0, | |
373 | }; | |
374 | ||
a07c8779 | 375 | if (!dvb_attach(xc5000_attach, |
30650961 | 376 | &t->fe, t->i2c->adapter, &xc5000_cfg)) |
b9ef6bbb | 377 | goto attach_failed; |
d6eef494 | 378 | tune_now = 0; |
27c685a4 | 379 | break; |
b9ef6bbb | 380 | } |
93463895 MK |
381 | case TUNER_NXP_TDA18271: |
382 | { | |
383 | struct tda18271_config cfg = { | |
384 | .config = t->config, | |
e350d44f | 385 | .small_i2c = TDA18271_03_BYTE_CHUNK_INIT, |
93463895 MK |
386 | }; |
387 | ||
9f3f71ef MCC |
388 | if (!dvb_attach(tda18271_attach, &t->fe, t->i2c->addr, |
389 | t->i2c->adapter, &cfg)) | |
390 | goto attach_failed; | |
391 | tune_now = 0; | |
392 | break; | |
393 | } | |
394 | default: | |
395 | if (!dvb_attach(simple_tuner_attach, &t->fe, | |
396 | t->i2c->adapter, t->i2c->addr, t->type)) | |
397 | goto attach_failed; | |
398 | ||
399 | break; | |
400 | } | |
401 | ||
402 | if ((NULL == analog_ops->set_params) && | |
403 | (fe_tuner_ops->set_analog_params)) { | |
404 | ||
405 | t->name = fe_tuner_ops->info.name; | |
406 | ||
407 | t->fe.analog_demod_priv = t; | |
408 | memcpy(analog_ops, &tuner_analog_ops, | |
409 | sizeof(struct analog_demod_ops)); | |
410 | ||
411 | } else { | |
412 | t->name = analog_ops->info.name; | |
413 | } | |
414 | ||
415 | tuner_dbg("type set to %s\n", t->name); | |
416 | ||
cbde6898 | 417 | t->mode_mask = new_mode_mask; |
9f3f71ef MCC |
418 | |
419 | /* Some tuners require more initialization setup before use, | |
420 | such as firmware download or device calibration. | |
421 | trying to set a frequency here will just fail | |
422 | FIXME: better to move set_freq to the tuner code. This is needed | |
423 | on analog tuners for PLL to properly work | |
424 | */ | |
425 | if (tune_now) { | |
426 | if (V4L2_TUNER_RADIO == t->mode) | |
427 | set_radio_freq(c, t->radio_freq); | |
428 | else | |
429 | set_tv_freq(c, t->tv_freq); | |
430 | } | |
431 | ||
432 | tuner_dbg("%s %s I2C addr 0x%02x with type %d used for 0x%02x\n", | |
433 | c->adapter->name, c->driver->driver.name, c->addr << 1, type, | |
434 | t->mode_mask); | |
435 | return; | |
436 | ||
437 | attach_failed: | |
438 | tuner_dbg("Tuner attach for type = %d failed.\n", t->type); | |
439 | t->type = TUNER_ABSENT; | |
9f3f71ef MCC |
440 | |
441 | return; | |
442 | } | |
443 | ||
0ae79d99 MCC |
444 | /** |
445 | * tuner_s_type_addr - Sets the tuner type for a device | |
446 | * | |
447 | * @sd: subdev descriptor | |
448 | * @tun_setup: type to be associated to a given tuner i2c address | |
449 | * | |
450 | * This function applys the tuner config to tuner specified | |
451 | * by tun_setup structure. | |
452 | * If tuner I2C address is UNSET, then it will only set the device | |
453 | * if the tuner supports the mode specified in the call. | |
454 | * If the address is specified, the change will be applied only if | |
455 | * tuner I2C address matches. | |
456 | * The call can change the tuner number and the tuner mode. | |
457 | */ | |
a34ec5f3 MCC |
458 | static int tuner_s_type_addr(struct v4l2_subdev *sd, |
459 | struct tuner_setup *tun_setup) | |
9f3f71ef | 460 | { |
a34ec5f3 MCC |
461 | struct tuner *t = to_tuner(sd); |
462 | struct i2c_client *c = v4l2_get_subdevdata(sd); | |
463 | ||
464 | tuner_dbg("Calling set_type_addr for type=%d, addr=0x%02x, mode=0x%02x, config=0x%02x\n", | |
465 | tun_setup->type, | |
466 | tun_setup->addr, | |
467 | tun_setup->mode_mask, | |
468 | tun_setup->config); | |
9f3f71ef | 469 | |
7d275bf8 MCC |
470 | if ((t->type == UNSET && ((tun_setup->addr == ADDR_UNSET) && |
471 | (t->mode_mask & tun_setup->mode_mask))) || | |
472 | (tun_setup->addr == c->addr)) { | |
cbde6898 MCC |
473 | set_type(c, tun_setup->type, tun_setup->mode_mask, |
474 | tun_setup->config, tun_setup->tuner_callback); | |
9f3f71ef MCC |
475 | } else |
476 | tuner_dbg("set addr discarded for type %i, mask %x. " | |
477 | "Asked to change tuner at addr 0x%02x, with mask %x\n", | |
478 | t->type, t->mode_mask, | |
479 | tun_setup->addr, tun_setup->mode_mask); | |
9f3f71ef | 480 | |
9f3f71ef MCC |
481 | return 0; |
482 | } | |
483 | ||
a2894e3f MCC |
484 | /** |
485 | * tuner_s_config - Sets tuner configuration | |
486 | * | |
487 | * @sd: subdev descriptor | |
488 | * @cfg: tuner configuration | |
489 | * | |
490 | * Calls tuner set_config() private function to set some tuner-internal | |
491 | * parameters | |
492 | */ | |
7d275bf8 MCC |
493 | static int tuner_s_config(struct v4l2_subdev *sd, |
494 | const struct v4l2_priv_tun_config *cfg) | |
9f3f71ef MCC |
495 | { |
496 | struct tuner *t = to_tuner(sd); | |
497 | struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops; | |
498 | ||
499 | if (t->type != cfg->tuner) | |
500 | return 0; | |
501 | ||
502 | if (analog_ops->set_config) { | |
503 | analog_ops->set_config(&t->fe, cfg->priv); | |
504 | return 0; | |
505 | } | |
506 | ||
507 | tuner_dbg("Tuner frontend module has no way to set config\n"); | |
508 | return 0; | |
509 | } | |
510 | ||
a2894e3f MCC |
511 | /** |
512 | * tuner_lookup - Seek for tuner adapters | |
513 | * | |
514 | * @adap: i2c_adapter struct | |
515 | * @radio: pointer to be filled if the adapter is radio | |
516 | * @tv: pointer to be filled if the adapter is TV | |
517 | * | |
518 | * Search for existing radio and/or TV tuners on the given I2C adapter, | |
519 | * discarding demod-only adapters (tda9887). | |
520 | * | |
521 | * Note that when this function is called from tuner_probe you can be | |
522 | * certain no other devices will be added/deleted at the same time, I2C | |
523 | * core protects against that. | |
524 | */ | |
9f3f71ef MCC |
525 | static void tuner_lookup(struct i2c_adapter *adap, |
526 | struct tuner **radio, struct tuner **tv) | |
527 | { | |
528 | struct tuner *pos; | |
529 | ||
530 | *radio = NULL; | |
531 | *tv = NULL; | |
532 | ||
533 | list_for_each_entry(pos, &tuner_list, list) { | |
534 | int mode_mask; | |
535 | ||
536 | if (pos->i2c->adapter != adap || | |
537 | strcmp(pos->i2c->driver->driver.name, "tuner")) | |
538 | continue; | |
539 | ||
cbde6898 | 540 | mode_mask = pos->mode_mask; |
9f3f71ef MCC |
541 | if (*radio == NULL && mode_mask == T_RADIO) |
542 | *radio = pos; | |
543 | /* Note: currently TDA9887 is the only demod-only | |
544 | device. If other devices appear then we need to | |
545 | make this test more general. */ | |
546 | else if (*tv == NULL && pos->type != TUNER_TDA9887 && | |
ad020dc2 | 547 | (pos->mode_mask & T_ANALOG_TV)) |
9f3f71ef MCC |
548 | *tv = pos; |
549 | } | |
550 | } | |
551 | ||
a2894e3f MCC |
552 | /** |
553 | *tuner_probe - Probes the existing tuners on an I2C bus | |
554 | * | |
555 | * @client: i2c_client descriptor | |
556 | * @id: not used | |
557 | * | |
558 | * This routine probes for tuners at the expected I2C addresses. On most | |
559 | * cases, if a device answers to a given I2C address, it assumes that the | |
560 | * device is a tuner. On a few cases, however, an additional logic is needed | |
561 | * to double check if the device is really a tuner, or to identify the tuner | |
562 | * type, like on tea5767/5761 devices. | |
563 | * | |
564 | * During client attach, set_type is called by adapter's attach_inform callback. | |
565 | * set_type must then be completed by tuner_probe. | |
9f3f71ef MCC |
566 | */ |
567 | static int tuner_probe(struct i2c_client *client, | |
568 | const struct i2c_device_id *id) | |
569 | { | |
570 | struct tuner *t; | |
571 | struct tuner *radio; | |
572 | struct tuner *tv; | |
573 | ||
574 | t = kzalloc(sizeof(struct tuner), GFP_KERNEL); | |
575 | if (NULL == t) | |
576 | return -ENOMEM; | |
577 | v4l2_i2c_subdev_init(&t->sd, client, &tuner_ops); | |
578 | t->i2c = client; | |
579 | t->name = "(tuner unset)"; | |
580 | t->type = UNSET; | |
581 | t->audmode = V4L2_TUNER_MODE_STEREO; | |
cbde6898 MCC |
582 | t->standby = 1; |
583 | t->radio_freq = 87.5 * 16000; /* Initial freq range */ | |
584 | t->tv_freq = 400 * 16; /* Sets freq to VHF High - needed for some PLL's to properly start */ | |
9f3f71ef MCC |
585 | |
586 | if (show_i2c) { | |
587 | unsigned char buffer[16]; | |
588 | int i, rc; | |
589 | ||
590 | memset(buffer, 0, sizeof(buffer)); | |
591 | rc = i2c_master_recv(client, buffer, sizeof(buffer)); | |
592 | tuner_info("I2C RECV = "); | |
593 | for (i = 0; i < rc; i++) | |
594 | printk(KERN_CONT "%02x ", buffer[i]); | |
595 | printk("\n"); | |
596 | } | |
597 | ||
598 | /* autodetection code based on the i2c addr */ | |
599 | if (!no_autodetect) { | |
600 | switch (client->addr) { | |
601 | case 0x10: | |
602 | if (tuner_symbol_probe(tea5761_autodetection, | |
603 | t->i2c->adapter, | |
604 | t->i2c->addr) >= 0) { | |
605 | t->type = TUNER_TEA5761; | |
606 | t->mode_mask = T_RADIO; | |
9f3f71ef MCC |
607 | tuner_lookup(t->i2c->adapter, &radio, &tv); |
608 | if (tv) | |
609 | tv->mode_mask &= ~T_RADIO; | |
610 | ||
611 | goto register_client; | |
612 | } | |
613 | kfree(t); | |
614 | return -ENODEV; | |
615 | case 0x42: | |
616 | case 0x43: | |
617 | case 0x4a: | |
618 | case 0x4b: | |
619 | /* If chip is not tda8290, don't register. | |
620 | since it can be tda9887*/ | |
621 | if (tuner_symbol_probe(tda829x_probe, t->i2c->adapter, | |
622 | t->i2c->addr) >= 0) { | |
623 | tuner_dbg("tda829x detected\n"); | |
624 | } else { | |
625 | /* Default is being tda9887 */ | |
626 | t->type = TUNER_TDA9887; | |
ad020dc2 | 627 | t->mode_mask = T_RADIO | T_ANALOG_TV; |
9f3f71ef MCC |
628 | goto register_client; |
629 | } | |
630 | break; | |
631 | case 0x60: | |
632 | if (tuner_symbol_probe(tea5767_autodetection, | |
633 | t->i2c->adapter, t->i2c->addr) | |
634 | >= 0) { | |
635 | t->type = TUNER_TEA5767; | |
636 | t->mode_mask = T_RADIO; | |
9f3f71ef | 637 | /* Sets freq to FM range */ |
9f3f71ef MCC |
638 | tuner_lookup(t->i2c->adapter, &radio, &tv); |
639 | if (tv) | |
640 | tv->mode_mask &= ~T_RADIO; | |
641 | ||
642 | goto register_client; | |
643 | } | |
644 | break; | |
645 | } | |
93463895 | 646 | } |
b9ef6bbb | 647 | |
9f3f71ef MCC |
648 | /* Initializes only the first TV tuner on this adapter. Why only the |
649 | first? Because there are some devices (notably the ones with TI | |
650 | tuners) that have more than one i2c address for the *same* device. | |
651 | Experience shows that, except for just one case, the first | |
652 | address is the right one. The exception is a Russian tuner | |
653 | (ACORP_Y878F). So, the desired behavior is just to enable the | |
654 | first found TV tuner. */ | |
655 | tuner_lookup(t->i2c->adapter, &radio, &tv); | |
656 | if (tv == NULL) { | |
ad020dc2 | 657 | t->mode_mask = T_ANALOG_TV; |
9f3f71ef MCC |
658 | if (radio == NULL) |
659 | t->mode_mask |= T_RADIO; | |
660 | tuner_dbg("Setting mode_mask to 0x%02x\n", t->mode_mask); | |
1da177e4 | 661 | } |
f7ce3cc6 | 662 | |
9f3f71ef MCC |
663 | /* Should be just before return */ |
664 | register_client: | |
9f3f71ef | 665 | /* Sets a default mode */ |
7d275bf8 | 666 | if (t->mode_mask & T_ANALOG_TV) |
9f3f71ef | 667 | t->mode = V4L2_TUNER_ANALOG_TV; |
7d275bf8 | 668 | else |
ad020dc2 | 669 | t->mode = V4L2_TUNER_RADIO; |
9f3f71ef MCC |
670 | set_type(client, t->type, t->mode_mask, t->config, t->fe.callback); |
671 | list_add_tail(&t->list, &tuner_list); | |
cbde6898 | 672 | |
ad020dc2 | 673 | tuner_info("Tuner %d found with type(s)%s%s.\n", |
cbde6898 | 674 | t->type, |
ad020dc2 MCC |
675 | t->mode_mask & T_RADIO ? " Radio" : "", |
676 | t->mode_mask & T_ANALOG_TV ? " TV" : ""); | |
9f3f71ef MCC |
677 | return 0; |
678 | } | |
e18f9444 | 679 | |
a2894e3f MCC |
680 | /** |
681 | * tuner_remove - detaches a tuner | |
682 | * | |
683 | * @client: i2c_client descriptor | |
684 | */ | |
685 | ||
9f3f71ef MCC |
686 | static int tuner_remove(struct i2c_client *client) |
687 | { | |
688 | struct tuner *t = to_tuner(i2c_get_clientdata(client)); | |
b9ef6bbb | 689 | |
9f3f71ef MCC |
690 | v4l2_device_unregister_subdev(&t->sd); |
691 | tuner_detach(&t->fe); | |
692 | t->fe.analog_demod_priv = NULL; | |
b9ef6bbb | 693 | |
9f3f71ef MCC |
694 | list_del(&t->list); |
695 | kfree(t); | |
696 | return 0; | |
1da177e4 LT |
697 | } |
698 | ||
0eec66c0 MCC |
699 | /* |
700 | * Functions to switch between Radio and TV | |
701 | * | |
702 | * A few cards have a separate I2C tuner for radio. Those routines | |
703 | * take care of switching between TV/Radio mode, filtering only the | |
704 | * commands that apply to the Radio or TV tuner. | |
705 | */ | |
706 | ||
707 | /** | |
708 | * check_mode - Verify if tuner supports the requested mode | |
709 | * @t: a pointer to the module's internal struct_tuner | |
710 | * | |
711 | * This function checks if the tuner is capable of tuning analog TV, | |
712 | * digital TV or radio, depending on what the caller wants. If the | |
713 | * tuner can't support that mode, it returns -EINVAL. Otherwise, it | |
714 | * returns 0. | |
715 | * This function is needed for boards that have a separate tuner for | |
716 | * radio (like devices with tea5767). | |
717 | */ | |
718 | static inline int check_mode(struct tuner *t, enum v4l2_tuner_type mode) | |
719 | { | |
720 | if ((1 << mode & t->mode_mask) == 0) | |
721 | return -EINVAL; | |
722 | ||
723 | return 0; | |
724 | } | |
725 | ||
726 | /** | |
4e4a31fb | 727 | * set_mode - Switch tuner to other mode. |
0eec66c0 MCC |
728 | * @t: a pointer to the module's internal struct_tuner |
729 | * @mode: enum v4l2_type (radio or TV) | |
0eec66c0 MCC |
730 | * |
731 | * If tuner doesn't support the needed mode (radio or TV), prints a | |
732 | * debug message and returns -EINVAL, changing its state to standby. | |
4e4a31fb | 733 | * Otherwise, changes the mode and returns 0. |
0eec66c0 | 734 | */ |
4e4a31fb | 735 | static int set_mode(struct tuner *t, enum v4l2_tuner_type mode) |
0eec66c0 MCC |
736 | { |
737 | struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops; | |
738 | ||
739 | if (mode != t->mode) { | |
740 | if (check_mode(t, mode) == -EINVAL) { | |
741 | tuner_dbg("Tuner doesn't support mode %d. " | |
742 | "Putting tuner to sleep\n", mode); | |
743 | t->standby = true; | |
744 | if (analog_ops->standby) | |
745 | analog_ops->standby(&t->fe); | |
746 | return -EINVAL; | |
747 | } | |
748 | t->mode = mode; | |
749 | tuner_dbg("Changing to mode %d\n", mode); | |
750 | } | |
4e4a31fb HV |
751 | return 0; |
752 | } | |
753 | ||
754 | /** | |
755 | * set_freq - Set the tuner to the desired frequency. | |
756 | * @t: a pointer to the module's internal struct_tuner | |
757 | * @freq: frequency to set (0 means to use the current frequency) | |
758 | */ | |
759 | static void set_freq(struct tuner *t, unsigned int freq) | |
760 | { | |
761 | struct i2c_client *client = v4l2_get_subdevdata(&t->sd); | |
762 | ||
0eec66c0 | 763 | if (t->mode == V4L2_TUNER_RADIO) { |
4e4a31fb HV |
764 | if (!freq) |
765 | freq = t->radio_freq; | |
766 | set_radio_freq(client, freq); | |
0eec66c0 | 767 | } else { |
4e4a31fb HV |
768 | if (!freq) |
769 | freq = t->tv_freq; | |
770 | set_tv_freq(client, freq); | |
0eec66c0 | 771 | } |
0eec66c0 MCC |
772 | } |
773 | ||
f7ce3cc6 | 774 | /* |
9f3f71ef MCC |
775 | * Functions that are specific for TV mode |
776 | */ | |
f7ce3cc6 | 777 | |
a2894e3f MCC |
778 | /** |
779 | * set_tv_freq - Set tuner frequency, freq in Units of 62.5 kHz = 1/16MHz | |
780 | * | |
781 | * @c: i2c_client descriptor | |
782 | * @freq: frequency | |
783 | */ | |
9f3f71ef | 784 | static void set_tv_freq(struct i2c_client *c, unsigned int freq) |
f7ce3cc6 | 785 | { |
e8a4a9e7 | 786 | struct tuner *t = to_tuner(i2c_get_clientdata(c)); |
9f3f71ef | 787 | struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops; |
f7ce3cc6 | 788 | |
9f3f71ef MCC |
789 | struct analog_parameters params = { |
790 | .mode = t->mode, | |
791 | .audmode = t->audmode, | |
792 | .std = t->std | |
793 | }; | |
56fc08ca | 794 | |
9f3f71ef | 795 | if (t->type == UNSET) { |
7d275bf8 | 796 | tuner_warn("tuner type not set\n"); |
9f3f71ef | 797 | return; |
793cf9e6 | 798 | } |
9f3f71ef | 799 | if (NULL == analog_ops->set_params) { |
7d275bf8 | 800 | tuner_warn("Tuner has no way to set tv freq\n"); |
9f3f71ef | 801 | return; |
56fc08ca | 802 | } |
9f3f71ef | 803 | if (freq < tv_range[0] * 16 || freq > tv_range[1] * 16) { |
7d275bf8 | 804 | tuner_dbg("TV freq (%d.%02d) out of range (%d-%d)\n", |
9f3f71ef MCC |
805 | freq / 16, freq % 16 * 100 / 16, tv_range[0], |
806 | tv_range[1]); | |
807 | /* V4L2 spec: if the freq is not possible then the closest | |
808 | possible value should be selected */ | |
809 | if (freq < tv_range[0] * 16) | |
810 | freq = tv_range[0] * 16; | |
811 | else | |
812 | freq = tv_range[1] * 16; | |
813 | } | |
814 | params.frequency = freq; | |
815 | tuner_dbg("tv freq set to %d.%02d\n", | |
816 | freq / 16, freq % 16 * 100 / 16); | |
817 | t->tv_freq = freq; | |
cbde6898 | 818 | t->standby = false; |
9f3f71ef MCC |
819 | |
820 | analog_ops->set_params(&t->fe, ¶ms); | |
56fc08ca | 821 | } |
56fc08ca | 822 | |
a2894e3f MCC |
823 | /** |
824 | * tuner_fixup_std - force a given video standard variant | |
825 | * | |
826 | * @t: tuner internal struct | |
827 | * | |
828 | * A few devices or drivers have problem to detect some standard variations. | |
829 | * On other operational systems, the drivers generally have a per-country | |
830 | * code, and some logic to apply per-country hacks. V4L2 API doesn't provide | |
831 | * such hacks. Instead, it relies on a proper video standard selection from | |
832 | * the userspace application. However, as some apps are buggy, not allowing | |
833 | * to distinguish all video standard variations, a modprobe parameter can | |
834 | * be used to force a video standard match. | |
835 | */ | |
1da177e4 LT |
836 | static int tuner_fixup_std(struct tuner *t) |
837 | { | |
838 | if ((t->std & V4L2_STD_PAL) == V4L2_STD_PAL) { | |
1da177e4 | 839 | switch (pal[0]) { |
e71ced1a | 840 | case '6': |
7d275bf8 | 841 | tuner_dbg("insmod fixup: PAL => PAL-60\n"); |
e71ced1a HV |
842 | t->std = V4L2_STD_PAL_60; |
843 | break; | |
1da177e4 LT |
844 | case 'b': |
845 | case 'B': | |
846 | case 'g': | |
847 | case 'G': | |
7d275bf8 | 848 | tuner_dbg("insmod fixup: PAL => PAL-BG\n"); |
1da177e4 LT |
849 | t->std = V4L2_STD_PAL_BG; |
850 | break; | |
851 | case 'i': | |
852 | case 'I': | |
7d275bf8 | 853 | tuner_dbg("insmod fixup: PAL => PAL-I\n"); |
1da177e4 LT |
854 | t->std = V4L2_STD_PAL_I; |
855 | break; | |
856 | case 'd': | |
857 | case 'D': | |
858 | case 'k': | |
859 | case 'K': | |
7d275bf8 | 860 | tuner_dbg("insmod fixup: PAL => PAL-DK\n"); |
1da177e4 LT |
861 | t->std = V4L2_STD_PAL_DK; |
862 | break; | |
f7ce3cc6 MCC |
863 | case 'M': |
864 | case 'm': | |
7d275bf8 | 865 | tuner_dbg("insmod fixup: PAL => PAL-M\n"); |
f7ce3cc6 MCC |
866 | t->std = V4L2_STD_PAL_M; |
867 | break; | |
868 | case 'N': | |
869 | case 'n': | |
7e578191 MCC |
870 | if (pal[1] == 'c' || pal[1] == 'C') { |
871 | tuner_dbg("insmod fixup: PAL => PAL-Nc\n"); | |
872 | t->std = V4L2_STD_PAL_Nc; | |
873 | } else { | |
7d275bf8 | 874 | tuner_dbg("insmod fixup: PAL => PAL-N\n"); |
7e578191 MCC |
875 | t->std = V4L2_STD_PAL_N; |
876 | } | |
f7ce3cc6 | 877 | break; |
21d4df37 MCC |
878 | case '-': |
879 | /* default parameter, do nothing */ | |
880 | break; | |
881 | default: | |
7d275bf8 | 882 | tuner_warn("pal= argument not recognised\n"); |
21d4df37 | 883 | break; |
1da177e4 LT |
884 | } |
885 | } | |
f7ce3cc6 MCC |
886 | if ((t->std & V4L2_STD_SECAM) == V4L2_STD_SECAM) { |
887 | switch (secam[0]) { | |
7e578191 MCC |
888 | case 'b': |
889 | case 'B': | |
890 | case 'g': | |
891 | case 'G': | |
892 | case 'h': | |
893 | case 'H': | |
894 | tuner_dbg("insmod fixup: SECAM => SECAM-BGH\n"); | |
7d275bf8 MCC |
895 | t->std = V4L2_STD_SECAM_B | |
896 | V4L2_STD_SECAM_G | | |
897 | V4L2_STD_SECAM_H; | |
7e578191 | 898 | break; |
f7ce3cc6 MCC |
899 | case 'd': |
900 | case 'D': | |
901 | case 'k': | |
902 | case 'K': | |
7d275bf8 | 903 | tuner_dbg("insmod fixup: SECAM => SECAM-DK\n"); |
f7ce3cc6 MCC |
904 | t->std = V4L2_STD_SECAM_DK; |
905 | break; | |
906 | case 'l': | |
907 | case 'L': | |
7d275bf8 MCC |
908 | if ((secam[1] == 'C') || (secam[1] == 'c')) { |
909 | tuner_dbg("insmod fixup: SECAM => SECAM-L'\n"); | |
800d3c6f MCC |
910 | t->std = V4L2_STD_SECAM_LC; |
911 | } else { | |
7d275bf8 | 912 | tuner_dbg("insmod fixup: SECAM => SECAM-L\n"); |
800d3c6f MCC |
913 | t->std = V4L2_STD_SECAM_L; |
914 | } | |
f7ce3cc6 | 915 | break; |
21d4df37 MCC |
916 | case '-': |
917 | /* default parameter, do nothing */ | |
918 | break; | |
919 | default: | |
7d275bf8 | 920 | tuner_warn("secam= argument not recognised\n"); |
21d4df37 | 921 | break; |
f7ce3cc6 MCC |
922 | } |
923 | } | |
924 | ||
7e578191 MCC |
925 | if ((t->std & V4L2_STD_NTSC) == V4L2_STD_NTSC) { |
926 | switch (ntsc[0]) { | |
927 | case 'm': | |
928 | case 'M': | |
929 | tuner_dbg("insmod fixup: NTSC => NTSC-M\n"); | |
930 | t->std = V4L2_STD_NTSC_M; | |
931 | break; | |
932 | case 'j': | |
933 | case 'J': | |
934 | tuner_dbg("insmod fixup: NTSC => NTSC_M_JP\n"); | |
935 | t->std = V4L2_STD_NTSC_M_JP; | |
936 | break; | |
d97a11e0 HV |
937 | case 'k': |
938 | case 'K': | |
939 | tuner_dbg("insmod fixup: NTSC => NTSC_M_KR\n"); | |
940 | t->std = V4L2_STD_NTSC_M_KR; | |
941 | break; | |
7e578191 MCC |
942 | case '-': |
943 | /* default parameter, do nothing */ | |
944 | break; | |
945 | default: | |
946 | tuner_info("ntsc= argument not recognised\n"); | |
947 | break; | |
948 | } | |
949 | } | |
9f3f71ef MCC |
950 | return 0; |
951 | } | |
952 | ||
953 | /* | |
954 | * Functions that are specific for Radio mode | |
955 | */ | |
956 | ||
a2894e3f MCC |
957 | /** |
958 | * set_radio_freq - Set tuner frequency, freq in Units of 62.5 Hz = 1/16kHz | |
959 | * | |
960 | * @c: i2c_client descriptor | |
961 | * @freq: frequency | |
962 | */ | |
9f3f71ef MCC |
963 | static void set_radio_freq(struct i2c_client *c, unsigned int freq) |
964 | { | |
965 | struct tuner *t = to_tuner(i2c_get_clientdata(c)); | |
966 | struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops; | |
967 | ||
968 | struct analog_parameters params = { | |
969 | .mode = t->mode, | |
970 | .audmode = t->audmode, | |
971 | .std = t->std | |
972 | }; | |
973 | ||
974 | if (t->type == UNSET) { | |
7d275bf8 | 975 | tuner_warn("tuner type not set\n"); |
9f3f71ef MCC |
976 | return; |
977 | } | |
978 | if (NULL == analog_ops->set_params) { | |
7d275bf8 | 979 | tuner_warn("tuner has no way to set radio frequency\n"); |
9f3f71ef MCC |
980 | return; |
981 | } | |
982 | if (freq < radio_range[0] * 16000 || freq > radio_range[1] * 16000) { | |
7d275bf8 | 983 | tuner_dbg("radio freq (%d.%02d) out of range (%d-%d)\n", |
9f3f71ef MCC |
984 | freq / 16000, freq % 16000 * 100 / 16000, |
985 | radio_range[0], radio_range[1]); | |
986 | /* V4L2 spec: if the freq is not possible then the closest | |
987 | possible value should be selected */ | |
988 | if (freq < radio_range[0] * 16000) | |
989 | freq = radio_range[0] * 16000; | |
990 | else | |
991 | freq = radio_range[1] * 16000; | |
992 | } | |
993 | params.frequency = freq; | |
994 | tuner_dbg("radio freq set to %d.%02d\n", | |
995 | freq / 16000, freq % 16000 * 100 / 16000); | |
996 | t->radio_freq = freq; | |
cbde6898 | 997 | t->standby = false; |
9f3f71ef MCC |
998 | |
999 | analog_ops->set_params(&t->fe, ¶ms); | |
1000 | } | |
1001 | ||
0eec66c0 MCC |
1002 | /* |
1003 | * Debug function for reporting tuner status to userspace | |
9f3f71ef | 1004 | */ |
9f3f71ef | 1005 | |
cbde6898 MCC |
1006 | /** |
1007 | * tuner_status - Dumps the current tuner status at dmesg | |
1008 | * @fe: pointer to struct dvb_frontend | |
1009 | * | |
1010 | * This callback is used only for driver debug purposes, answering to | |
1011 | * VIDIOC_LOG_STATUS. No changes should happen on this call. | |
1012 | */ | |
4e9154b8 | 1013 | static void tuner_status(struct dvb_frontend *fe) |
7e578191 | 1014 | { |
4e9154b8 | 1015 | struct tuner *t = fe->analog_demod_priv; |
7e578191 | 1016 | unsigned long freq, freq_fraction; |
a07c8779 MK |
1017 | struct dvb_tuner_ops *fe_tuner_ops = &fe->ops.tuner_ops; |
1018 | struct analog_demod_ops *analog_ops = &fe->ops.analog_ops; | |
7e578191 MCC |
1019 | const char *p; |
1020 | ||
1021 | switch (t->mode) { | |
7d275bf8 MCC |
1022 | case V4L2_TUNER_RADIO: |
1023 | p = "radio"; | |
1024 | break; | |
1025 | case V4L2_TUNER_DIGITAL_TV: | |
1026 | p = "digital TV"; | |
1027 | break; | |
1028 | case V4L2_TUNER_ANALOG_TV: | |
1029 | default: | |
1030 | p = "analog TV"; | |
1031 | break; | |
7e578191 MCC |
1032 | } |
1033 | if (t->mode == V4L2_TUNER_RADIO) { | |
27487d44 HV |
1034 | freq = t->radio_freq / 16000; |
1035 | freq_fraction = (t->radio_freq % 16000) * 100 / 16000; | |
7e578191 | 1036 | } else { |
27487d44 HV |
1037 | freq = t->tv_freq / 16; |
1038 | freq_fraction = (t->tv_freq % 16) * 100 / 16; | |
7e578191 | 1039 | } |
cbde6898 MCC |
1040 | tuner_info("Tuner mode: %s%s\n", p, |
1041 | t->standby ? " on standby mode" : ""); | |
7e578191 | 1042 | tuner_info("Frequency: %lu.%02lu MHz\n", freq, freq_fraction); |
4ae5c2e5 | 1043 | tuner_info("Standard: 0x%08lx\n", (unsigned long)t->std); |
8a4b275f | 1044 | if (t->mode != V4L2_TUNER_RADIO) |
7d275bf8 | 1045 | return; |
e18f9444 MK |
1046 | if (fe_tuner_ops->get_status) { |
1047 | u32 tuner_status; | |
1048 | ||
1049 | fe_tuner_ops->get_status(&t->fe, &tuner_status); | |
1050 | if (tuner_status & TUNER_STATUS_LOCKED) | |
1051 | tuner_info("Tuner is locked.\n"); | |
1052 | if (tuner_status & TUNER_STATUS_STEREO) | |
1053 | tuner_info("Stereo: yes\n"); | |
1054 | } | |
bc3e5c7f MK |
1055 | if (analog_ops->has_signal) |
1056 | tuner_info("Signal strength: %d\n", | |
1057 | analog_ops->has_signal(fe)); | |
7e578191 | 1058 | } |
8a4b275f | 1059 | |
0eec66c0 MCC |
1060 | /* |
1061 | * Function to splicitly change mode to radio. Probably not needed anymore | |
1062 | */ | |
1063 | ||
1064 | static int tuner_s_radio(struct v4l2_subdev *sd) | |
1065 | { | |
1066 | struct tuner *t = to_tuner(sd); | |
0eec66c0 | 1067 | |
4e4a31fb HV |
1068 | if (set_mode(t, V4L2_TUNER_RADIO) == 0) |
1069 | set_freq(t, 0); | |
0eec66c0 MCC |
1070 | return 0; |
1071 | } | |
1072 | ||
1073 | /* | |
1074 | * Tuner callbacks to handle userspace ioctl's | |
1075 | */ | |
1076 | ||
cbde6898 MCC |
1077 | /** |
1078 | * tuner_s_power - controls the power state of the tuner | |
1079 | * @sd: pointer to struct v4l2_subdev | |
1080 | * @on: a zero value puts the tuner to sleep | |
1081 | */ | |
622b828a | 1082 | static int tuner_s_power(struct v4l2_subdev *sd, int on) |
e8a4a9e7 HV |
1083 | { |
1084 | struct tuner *t = to_tuner(sd); | |
bc3e5c7f | 1085 | struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops; |
1da177e4 | 1086 | |
cbde6898 | 1087 | /* FIXME: Why this function don't wake the tuner if on != 0 ? */ |
622b828a LP |
1088 | if (on) |
1089 | return 0; | |
1090 | ||
16a5e53d | 1091 | tuner_dbg("Putting tuner to sleep\n"); |
cbde6898 | 1092 | t->standby = true; |
e8a4a9e7 HV |
1093 | if (analog_ops->standby) |
1094 | analog_ops->standby(&t->fe); | |
1095 | return 0; | |
1096 | } | |
5e453dc7 | 1097 | |
e8a4a9e7 HV |
1098 | static int tuner_s_std(struct v4l2_subdev *sd, v4l2_std_id std) |
1099 | { | |
1100 | struct tuner *t = to_tuner(sd); | |
f7ce3cc6 | 1101 | |
4e4a31fb | 1102 | if (set_mode(t, V4L2_TUNER_ANALOG_TV)) |
e8a4a9e7 | 1103 | return 0; |
f7ce3cc6 | 1104 | |
e8a4a9e7 HV |
1105 | t->std = std; |
1106 | tuner_fixup_std(t); | |
4e4a31fb | 1107 | set_freq(t, 0); |
e8a4a9e7 HV |
1108 | return 0; |
1109 | } | |
f7ce3cc6 | 1110 | |
e8a4a9e7 HV |
1111 | static int tuner_s_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *f) |
1112 | { | |
1113 | struct tuner *t = to_tuner(sd); | |
8a4b275f | 1114 | |
4e4a31fb HV |
1115 | if (set_mode(t, f->type) == 0) |
1116 | set_freq(t, f->frequency); | |
e8a4a9e7 HV |
1117 | return 0; |
1118 | } | |
f7ce3cc6 | 1119 | |
e8a4a9e7 HV |
1120 | static int tuner_g_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *f) |
1121 | { | |
1122 | struct tuner *t = to_tuner(sd); | |
1123 | struct dvb_tuner_ops *fe_tuner_ops = &t->fe.ops.tuner_ops; | |
f7ce3cc6 | 1124 | |
cbde6898 | 1125 | if (check_mode(t, f->type) == -EINVAL) |
e8a4a9e7 | 1126 | return 0; |
e8a4a9e7 | 1127 | f->type = t->mode; |
cbde6898 | 1128 | if (fe_tuner_ops->get_frequency && !t->standby) { |
e8a4a9e7 HV |
1129 | u32 abs_freq; |
1130 | ||
1131 | fe_tuner_ops->get_frequency(&t->fe, &abs_freq); | |
1132 | f->frequency = (V4L2_TUNER_RADIO == t->mode) ? | |
75b697f7 JL |
1133 | DIV_ROUND_CLOSEST(abs_freq * 2, 125) : |
1134 | DIV_ROUND_CLOSEST(abs_freq, 62500); | |
cbde6898 MCC |
1135 | } else { |
1136 | f->frequency = (V4L2_TUNER_RADIO == t->mode) ? | |
1137 | t->radio_freq : t->tv_freq; | |
e8a4a9e7 | 1138 | } |
e8a4a9e7 HV |
1139 | return 0; |
1140 | } | |
f7ce3cc6 | 1141 | |
e8a4a9e7 HV |
1142 | static int tuner_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt) |
1143 | { | |
1144 | struct tuner *t = to_tuner(sd); | |
1145 | struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops; | |
1146 | struct dvb_tuner_ops *fe_tuner_ops = &t->fe.ops.tuner_ops; | |
1147 | ||
cbde6898 | 1148 | if (check_mode(t, vt->type) == -EINVAL) |
e8a4a9e7 | 1149 | return 0; |
e8a4a9e7 HV |
1150 | vt->type = t->mode; |
1151 | if (analog_ops->get_afc) | |
1152 | vt->afc = analog_ops->get_afc(&t->fe); | |
1153 | if (t->mode == V4L2_TUNER_ANALOG_TV) | |
1154 | vt->capability |= V4L2_TUNER_CAP_NORM; | |
1155 | if (t->mode != V4L2_TUNER_RADIO) { | |
1156 | vt->rangelow = tv_range[0] * 16; | |
1157 | vt->rangehigh = tv_range[1] * 16; | |
1158 | return 0; | |
1159 | } | |
1160 | ||
1161 | /* radio mode */ | |
cbde6898 | 1162 | vt->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO; |
e8a4a9e7 HV |
1163 | if (fe_tuner_ops->get_status) { |
1164 | u32 tuner_status; | |
1165 | ||
1166 | fe_tuner_ops->get_status(&t->fe, &tuner_status); | |
1167 | vt->rxsubchans = | |
1168 | (tuner_status & TUNER_STATUS_STEREO) ? | |
1169 | V4L2_TUNER_SUB_STEREO : | |
1170 | V4L2_TUNER_SUB_MONO; | |
1da177e4 | 1171 | } |
e8a4a9e7 HV |
1172 | if (analog_ops->has_signal) |
1173 | vt->signal = analog_ops->has_signal(&t->fe); | |
cbde6898 | 1174 | vt->capability |= V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO; |
e8a4a9e7 HV |
1175 | vt->audmode = t->audmode; |
1176 | vt->rangelow = radio_range[0] * 16000; | |
1177 | vt->rangehigh = radio_range[1] * 16000; | |
cbde6898 | 1178 | |
e8a4a9e7 HV |
1179 | return 0; |
1180 | } | |
1181 | ||
1182 | static int tuner_s_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt) | |
1183 | { | |
1184 | struct tuner *t = to_tuner(sd); | |
e8a4a9e7 | 1185 | |
4e4a31fb | 1186 | if (set_mode(t, vt->type)) |
e8a4a9e7 HV |
1187 | return 0; |
1188 | ||
cbde6898 MCC |
1189 | if (t->mode == V4L2_TUNER_RADIO) |
1190 | t->audmode = vt->audmode; | |
4e4a31fb | 1191 | set_freq(t, 0); |
cbde6898 | 1192 | |
e8a4a9e7 HV |
1193 | return 0; |
1194 | } | |
1195 | ||
1196 | static int tuner_log_status(struct v4l2_subdev *sd) | |
1197 | { | |
1198 | struct tuner *t = to_tuner(sd); | |
1199 | struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops; | |
1da177e4 | 1200 | |
e8a4a9e7 HV |
1201 | if (analog_ops->tuner_status) |
1202 | analog_ops->tuner_status(&t->fe); | |
1da177e4 LT |
1203 | return 0; |
1204 | } | |
1205 | ||
21b48a70 | 1206 | static int tuner_suspend(struct i2c_client *c, pm_message_t state) |
1da177e4 | 1207 | { |
e8a4a9e7 | 1208 | struct tuner *t = to_tuner(i2c_get_clientdata(c)); |
e2f63d9b | 1209 | struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops; |
1da177e4 | 1210 | |
9dd659de | 1211 | tuner_dbg("suspend\n"); |
e2f63d9b MCC |
1212 | |
1213 | if (!t->standby && analog_ops->standby) | |
1214 | analog_ops->standby(&t->fe); | |
1215 | ||
1da177e4 LT |
1216 | return 0; |
1217 | } | |
1218 | ||
21b48a70 | 1219 | static int tuner_resume(struct i2c_client *c) |
1da177e4 | 1220 | { |
e8a4a9e7 | 1221 | struct tuner *t = to_tuner(i2c_get_clientdata(c)); |
1da177e4 | 1222 | |
9dd659de | 1223 | tuner_dbg("resume\n"); |
e2f63d9b MCC |
1224 | |
1225 | if (!t->standby) | |
9bf0ef06 | 1226 | if (set_mode(t, t->mode) == 0) |
4e4a31fb | 1227 | set_freq(t, 0); |
e2f63d9b | 1228 | |
1da177e4 LT |
1229 | return 0; |
1230 | } | |
1231 | ||
75b4c260 HV |
1232 | static int tuner_command(struct i2c_client *client, unsigned cmd, void *arg) |
1233 | { | |
1234 | struct v4l2_subdev *sd = i2c_get_clientdata(client); | |
1235 | ||
1236 | /* TUNER_SET_CONFIG is still called by tuner-simple.c, so we have | |
1237 | to handle it here. | |
1238 | There must be a better way of doing this... */ | |
1239 | switch (cmd) { | |
1240 | case TUNER_SET_CONFIG: | |
1241 | return tuner_s_config(sd, arg); | |
1242 | } | |
1243 | return -ENOIOCTLCMD; | |
1244 | } | |
1245 | ||
a2894e3f MCC |
1246 | /* |
1247 | * Callback structs | |
1248 | */ | |
e8a4a9e7 HV |
1249 | |
1250 | static const struct v4l2_subdev_core_ops tuner_core_ops = { | |
1251 | .log_status = tuner_log_status, | |
f41737ec | 1252 | .s_std = tuner_s_std, |
622b828a | 1253 | .s_power = tuner_s_power, |
e8a4a9e7 HV |
1254 | }; |
1255 | ||
1256 | static const struct v4l2_subdev_tuner_ops tuner_tuner_ops = { | |
e8a4a9e7 HV |
1257 | .s_radio = tuner_s_radio, |
1258 | .g_tuner = tuner_g_tuner, | |
1259 | .s_tuner = tuner_s_tuner, | |
1260 | .s_frequency = tuner_s_frequency, | |
1261 | .g_frequency = tuner_g_frequency, | |
1262 | .s_type_addr = tuner_s_type_addr, | |
1263 | .s_config = tuner_s_config, | |
1264 | }; | |
1265 | ||
1266 | static const struct v4l2_subdev_ops tuner_ops = { | |
1267 | .core = &tuner_core_ops, | |
1268 | .tuner = &tuner_tuner_ops, | |
1269 | }; | |
1270 | ||
a2894e3f MCC |
1271 | /* |
1272 | * I2C structs and module init functions | |
1273 | */ | |
1da177e4 | 1274 | |
af294867 JD |
1275 | static const struct i2c_device_id tuner_id[] = { |
1276 | { "tuner", }, /* autodetect */ | |
1277 | { } | |
1278 | }; | |
1279 | MODULE_DEVICE_TABLE(i2c, tuner_id); | |
1280 | ||
02a2098a HV |
1281 | static struct i2c_driver tuner_driver = { |
1282 | .driver = { | |
1283 | .owner = THIS_MODULE, | |
1284 | .name = "tuner", | |
1285 | }, | |
1286 | .probe = tuner_probe, | |
1287 | .remove = tuner_remove, | |
1288 | .command = tuner_command, | |
1289 | .suspend = tuner_suspend, | |
1290 | .resume = tuner_resume, | |
1291 | .id_table = tuner_id, | |
1da177e4 | 1292 | }; |
1da177e4 | 1293 | |
02a2098a HV |
1294 | static __init int init_tuner(void) |
1295 | { | |
1296 | return i2c_add_driver(&tuner_driver); | |
1297 | } | |
1298 | ||
1299 | static __exit void exit_tuner(void) | |
1300 | { | |
1301 | i2c_del_driver(&tuner_driver); | |
1302 | } | |
1303 | ||
1304 | module_init(init_tuner); | |
1305 | module_exit(exit_tuner); | |
1306 | ||
9f3f71ef MCC |
1307 | MODULE_DESCRIPTION("device driver for various TV and TV+FM radio tuners"); |
1308 | MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer"); | |
1309 | MODULE_LICENSE("GPL"); |