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