1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375 |
- /*
- * i2c tv tuner chip device driver
- * core core, i.e. kernel interfaces, registering and so on
- *
- * Copyright(c) by Ralph Metzler, Gerd Knorr, Gunther Mayer
- *
- * Copyright(c) 2005-2011 by Mauro Carvalho Chehab
- * - Added support for a separate Radio tuner
- * - Major rework and cleanups at the code
- *
- * This driver supports many devices and the idea is to let the driver
- * detect which device is present. So rather than listing all supported
- * devices here, we pretend to support a single, fake device type that will
- * handle both radio and analog TV tuning.
- */
- #include <linux/module.h>
- #include <linux/kernel.h>
- #include <linux/string.h>
- #include <linux/timer.h>
- #include <linux/delay.h>
- #include <linux/errno.h>
- #include <linux/slab.h>
- #include <linux/poll.h>
- #include <linux/i2c.h>
- #include <linux/types.h>
- #include <linux/init.h>
- #include <linux/videodev2.h>
- #include <media/tuner.h>
- #include <media/tuner-types.h>
- #include <media/v4l2-device.h>
- #include <media/v4l2-ioctl.h>
- #include "mt20xx.h"
- #include "tda8290.h"
- #include "tea5761.h"
- #include "tea5767.h"
- #include "tuner-xc2028.h"
- #include "tuner-simple.h"
- #include "tda9887.h"
- #include "xc5000.h"
- #include "tda18271.h"
- #include "xc4000.h"
- #define UNSET (-1U)
- /*
- * Driver modprobe parameters
- */
- /* insmod options used at init time => read/only */
- static unsigned int addr;
- static unsigned int no_autodetect;
- static unsigned int show_i2c;
- module_param(addr, int, 0444);
- module_param(no_autodetect, int, 0444);
- module_param(show_i2c, int, 0444);
- /* insmod options used at runtime => read/write */
- static int tuner_debug;
- static unsigned int tv_range[2] = { 44, 958 };
- static unsigned int radio_range[2] = { 65, 108 };
- static char pal[] = "--";
- static char secam[] = "--";
- static char ntsc[] = "-";
- module_param_named(debug, tuner_debug, int, 0644);
- module_param_array(tv_range, int, NULL, 0644);
- module_param_array(radio_range, int, NULL, 0644);
- module_param_string(pal, pal, sizeof(pal), 0644);
- module_param_string(secam, secam, sizeof(secam), 0644);
- module_param_string(ntsc, ntsc, sizeof(ntsc), 0644);
- /*
- * Static vars
- */
- static LIST_HEAD(tuner_list);
- static const struct v4l2_subdev_ops tuner_ops;
- /*
- * Debug macros
- */
- #undef pr_fmt
- #define pr_fmt(fmt) KBUILD_MODNAME ": %d-%04x: " fmt, \
- i2c_adapter_id(t->i2c->adapter), t->i2c->addr
- #define dprintk(fmt, arg...) do { \
- if (tuner_debug) \
- printk(KERN_DEBUG pr_fmt("%s: " fmt), __func__, ##arg); \
- } while (0)
- /*
- * Internal struct used inside the driver
- */
- struct tuner {
- /* device */
- struct dvb_frontend fe;
- struct i2c_client *i2c;
- struct v4l2_subdev sd;
- struct list_head list;
- /* keep track of the current settings */
- v4l2_std_id std;
- unsigned int tv_freq;
- unsigned int radio_freq;
- unsigned int audmode;
- enum v4l2_tuner_type mode;
- unsigned int mode_mask; /* Combination of allowable modes */
- bool standby; /* Standby mode */
- unsigned int type; /* chip type id */
- void *config;
- const char *name;
- #if defined(CONFIG_MEDIA_CONTROLLER)
- struct media_pad pad[TUNER_NUM_PADS];
- #endif
- };
- /*
- * Function prototypes
- */
- static void set_tv_freq(struct i2c_client *c, unsigned int freq);
- static void set_radio_freq(struct i2c_client *c, unsigned int freq);
- /*
- * tuner attach/detach logic
- */
- /* This macro allows us to probe dynamically, avoiding static links */
- #ifdef CONFIG_MEDIA_ATTACH
- #define tuner_symbol_probe(FUNCTION, ARGS...) ({ \
- int __r = -EINVAL; \
- typeof(&FUNCTION) __a = symbol_request(FUNCTION); \
- if (__a) { \
- __r = (int) __a(ARGS); \
- symbol_put(FUNCTION); \
- } else { \
- printk(KERN_ERR "TUNER: Unable to find " \
- "symbol "#FUNCTION"()\n"); \
- } \
- __r; \
- })
- static void tuner_detach(struct dvb_frontend *fe)
- {
- if (fe->ops.tuner_ops.release) {
- fe->ops.tuner_ops.release(fe);
- symbol_put_addr(fe->ops.tuner_ops.release);
- }
- if (fe->ops.analog_ops.release) {
- fe->ops.analog_ops.release(fe);
- symbol_put_addr(fe->ops.analog_ops.release);
- }
- }
- #else
- #define tuner_symbol_probe(FUNCTION, ARGS...) ({ \
- FUNCTION(ARGS); \
- })
- static void tuner_detach(struct dvb_frontend *fe)
- {
- if (fe->ops.tuner_ops.release)
- fe->ops.tuner_ops.release(fe);
- if (fe->ops.analog_ops.release)
- fe->ops.analog_ops.release(fe);
- }
- #endif
- static inline struct tuner *to_tuner(struct v4l2_subdev *sd)
- {
- return container_of(sd, struct tuner, sd);
- }
- /*
- * struct analog_demod_ops callbacks
- */
- static void fe_set_params(struct dvb_frontend *fe,
- struct analog_parameters *params)
- {
- struct dvb_tuner_ops *fe_tuner_ops = &fe->ops.tuner_ops;
- struct tuner *t = fe->analog_demod_priv;
- if (NULL == fe_tuner_ops->set_analog_params) {
- pr_warn("Tuner frontend module has no way to set freq\n");
- return;
- }
- fe_tuner_ops->set_analog_params(fe, params);
- }
- static void fe_standby(struct dvb_frontend *fe)
- {
- struct dvb_tuner_ops *fe_tuner_ops = &fe->ops.tuner_ops;
- if (fe_tuner_ops->sleep)
- fe_tuner_ops->sleep(fe);
- }
- static int fe_set_config(struct dvb_frontend *fe, void *priv_cfg)
- {
- struct dvb_tuner_ops *fe_tuner_ops = &fe->ops.tuner_ops;
- struct tuner *t = fe->analog_demod_priv;
- if (fe_tuner_ops->set_config)
- return fe_tuner_ops->set_config(fe, priv_cfg);
- pr_warn("Tuner frontend module has no way to set config\n");
- return 0;
- }
- static void tuner_status(struct dvb_frontend *fe);
- static const struct analog_demod_ops tuner_analog_ops = {
- .set_params = fe_set_params,
- .standby = fe_standby,
- .set_config = fe_set_config,
- .tuner_status = tuner_status
- };
- /*
- * Functions to select between radio and TV and tuner probe/remove functions
- */
- /**
- * set_type - Sets the tuner type for a given device
- *
- * @c: i2c_client descriptor
- * @type: type of the tuner (e. g. tuner number)
- * @new_mode_mask: Indicates if tuner supports TV and/or Radio
- * @new_config: an optional parameter used by a few tuners to adjust
- * internal parameters, like LNA mode
- * @tuner_callback: an optional function to be called when switching
- * to analog mode
- *
- * This function applies the tuner config to tuner specified
- * by tun_setup structure. It contains several per-tuner initialization "magic"
- */
- static void set_type(struct i2c_client *c, unsigned int type,
- unsigned int new_mode_mask, void *new_config,
- int (*tuner_callback) (void *dev, int component, int cmd, int arg))
- {
- struct tuner *t = to_tuner(i2c_get_clientdata(c));
- struct dvb_tuner_ops *fe_tuner_ops = &t->fe.ops.tuner_ops;
- struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
- unsigned char buffer[4];
- int tune_now = 1;
- if (type == UNSET || type == TUNER_ABSENT) {
- dprintk("tuner 0x%02x: Tuner type absent\n", c->addr);
- return;
- }
- t->type = type;
- t->config = new_config;
- if (tuner_callback != NULL) {
- dprintk("defining GPIO callback\n");
- t->fe.callback = tuner_callback;
- }
- /* discard private data, in case set_type() was previously called */
- tuner_detach(&t->fe);
- t->fe.analog_demod_priv = NULL;
- switch (t->type) {
- case TUNER_MT2032:
- if (!dvb_attach(microtune_attach,
- &t->fe, t->i2c->adapter, t->i2c->addr))
- goto attach_failed;
- break;
- case TUNER_PHILIPS_TDA8290:
- {
- if (!dvb_attach(tda829x_attach, &t->fe, t->i2c->adapter,
- t->i2c->addr, t->config))
- goto attach_failed;
- break;
- }
- case TUNER_TEA5767:
- if (!dvb_attach(tea5767_attach, &t->fe,
- t->i2c->adapter, t->i2c->addr))
- goto attach_failed;
- t->mode_mask = T_RADIO;
- break;
- case TUNER_TEA5761:
- if (!dvb_attach(tea5761_attach, &t->fe,
- t->i2c->adapter, t->i2c->addr))
- goto attach_failed;
- t->mode_mask = T_RADIO;
- break;
- case TUNER_PHILIPS_FMD1216ME_MK3:
- case TUNER_PHILIPS_FMD1216MEX_MK3:
- buffer[0] = 0x0b;
- buffer[1] = 0xdc;
- buffer[2] = 0x9c;
- buffer[3] = 0x60;
- i2c_master_send(c, buffer, 4);
- mdelay(1);
- buffer[2] = 0x86;
- buffer[3] = 0x54;
- i2c_master_send(c, buffer, 4);
- if (!dvb_attach(simple_tuner_attach, &t->fe,
- t->i2c->adapter, t->i2c->addr, t->type))
- goto attach_failed;
- break;
- case TUNER_PHILIPS_TD1316:
- buffer[0] = 0x0b;
- buffer[1] = 0xdc;
- buffer[2] = 0x86;
- buffer[3] = 0xa4;
- i2c_master_send(c, buffer, 4);
- if (!dvb_attach(simple_tuner_attach, &t->fe,
- t->i2c->adapter, t->i2c->addr, t->type))
- goto attach_failed;
- break;
- case TUNER_XC2028:
- {
- struct xc2028_config cfg = {
- .i2c_adap = t->i2c->adapter,
- .i2c_addr = t->i2c->addr,
- };
- if (!dvb_attach(xc2028_attach, &t->fe, &cfg))
- goto attach_failed;
- tune_now = 0;
- break;
- }
- case TUNER_TDA9887:
- if (!dvb_attach(tda9887_attach,
- &t->fe, t->i2c->adapter, t->i2c->addr))
- goto attach_failed;
- break;
- case TUNER_XC5000:
- {
- struct xc5000_config xc5000_cfg = {
- .i2c_address = t->i2c->addr,
- /* if_khz will be set at dvb_attach() */
- .if_khz = 0,
- };
- if (!dvb_attach(xc5000_attach,
- &t->fe, t->i2c->adapter, &xc5000_cfg))
- goto attach_failed;
- tune_now = 0;
- break;
- }
- case TUNER_XC5000C:
- {
- struct xc5000_config xc5000c_cfg = {
- .i2c_address = t->i2c->addr,
- /* if_khz will be set at dvb_attach() */
- .if_khz = 0,
- .chip_id = XC5000C,
- };
- if (!dvb_attach(xc5000_attach,
- &t->fe, t->i2c->adapter, &xc5000c_cfg))
- goto attach_failed;
- tune_now = 0;
- break;
- }
- case TUNER_NXP_TDA18271:
- {
- struct tda18271_config cfg = {
- .small_i2c = TDA18271_03_BYTE_CHUNK_INIT,
- };
- if (!dvb_attach(tda18271_attach, &t->fe, t->i2c->addr,
- t->i2c->adapter, &cfg))
- goto attach_failed;
- tune_now = 0;
- break;
- }
- case TUNER_XC4000:
- {
- struct xc4000_config xc4000_cfg = {
- .i2c_address = t->i2c->addr,
- /* FIXME: the correct parameters will be set */
- /* only when the digital dvb_attach() occurs */
- .default_pm = 0,
- .dvb_amplitude = 0,
- .set_smoothedcvbs = 0,
- .if_khz = 0
- };
- if (!dvb_attach(xc4000_attach,
- &t->fe, t->i2c->adapter, &xc4000_cfg))
- goto attach_failed;
- tune_now = 0;
- break;
- }
- default:
- if (!dvb_attach(simple_tuner_attach, &t->fe,
- t->i2c->adapter, t->i2c->addr, t->type))
- goto attach_failed;
- break;
- }
- if ((NULL == analog_ops->set_params) &&
- (fe_tuner_ops->set_analog_params)) {
- t->name = fe_tuner_ops->info.name;
- t->fe.analog_demod_priv = t;
- memcpy(analog_ops, &tuner_analog_ops,
- sizeof(struct analog_demod_ops));
- if (fe_tuner_ops->get_rf_strength)
- analog_ops->has_signal = fe_tuner_ops->get_rf_strength;
- if (fe_tuner_ops->get_afc)
- analog_ops->get_afc = fe_tuner_ops->get_afc;
- } else {
- t->name = analog_ops->info.name;
- }
- #ifdef CONFIG_MEDIA_CONTROLLER
- t->sd.entity.name = t->name;
- #endif
- dprintk("type set to %s\n", t->name);
- t->mode_mask = new_mode_mask;
- /* Some tuners require more initialization setup before use,
- such as firmware download or device calibration.
- trying to set a frequency here will just fail
- FIXME: better to move set_freq to the tuner code. This is needed
- on analog tuners for PLL to properly work
- */
- if (tune_now) {
- if (V4L2_TUNER_RADIO == t->mode)
- set_radio_freq(c, t->radio_freq);
- else
- set_tv_freq(c, t->tv_freq);
- }
- dprintk("%s %s I2C addr 0x%02x with type %d used for 0x%02x\n",
- c->adapter->name, c->dev.driver->name, c->addr << 1, type,
- t->mode_mask);
- return;
- attach_failed:
- dprintk("Tuner attach for type = %d failed.\n", t->type);
- t->type = TUNER_ABSENT;
- return;
- }
- /**
- * tuner_s_type_addr - Sets the tuner type for a device
- *
- * @sd: subdev descriptor
- * @tun_setup: type to be associated to a given tuner i2c address
- *
- * This function applies the tuner config to tuner specified
- * by tun_setup structure.
- * If tuner I2C address is UNSET, then it will only set the device
- * if the tuner supports the mode specified in the call.
- * If the address is specified, the change will be applied only if
- * tuner I2C address matches.
- * The call can change the tuner number and the tuner mode.
- */
- static int tuner_s_type_addr(struct v4l2_subdev *sd,
- struct tuner_setup *tun_setup)
- {
- struct tuner *t = to_tuner(sd);
- struct i2c_client *c = v4l2_get_subdevdata(sd);
- dprintk("Calling set_type_addr for type=%d, addr=0x%02x, mode=0x%02x, config=%p\n",
- tun_setup->type,
- tun_setup->addr,
- tun_setup->mode_mask,
- tun_setup->config);
- if ((t->type == UNSET && ((tun_setup->addr == ADDR_UNSET) &&
- (t->mode_mask & tun_setup->mode_mask))) ||
- (tun_setup->addr == c->addr)) {
- set_type(c, tun_setup->type, tun_setup->mode_mask,
- tun_setup->config, tun_setup->tuner_callback);
- } else
- dprintk("set addr discarded for type %i, mask %x. Asked to change tuner at addr 0x%02x, with mask %x\n",
- t->type, t->mode_mask,
- tun_setup->addr, tun_setup->mode_mask);
- return 0;
- }
- /**
- * tuner_s_config - Sets tuner configuration
- *
- * @sd: subdev descriptor
- * @cfg: tuner configuration
- *
- * Calls tuner set_config() private function to set some tuner-internal
- * parameters
- */
- static int tuner_s_config(struct v4l2_subdev *sd,
- const struct v4l2_priv_tun_config *cfg)
- {
- struct tuner *t = to_tuner(sd);
- struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
- if (t->type != cfg->tuner)
- return 0;
- if (analog_ops->set_config) {
- analog_ops->set_config(&t->fe, cfg->priv);
- return 0;
- }
- dprintk("Tuner frontend module has no way to set config\n");
- return 0;
- }
- /**
- * tuner_lookup - Seek for tuner adapters
- *
- * @adap: i2c_adapter struct
- * @radio: pointer to be filled if the adapter is radio
- * @tv: pointer to be filled if the adapter is TV
- *
- * Search for existing radio and/or TV tuners on the given I2C adapter,
- * discarding demod-only adapters (tda9887).
- *
- * Note that when this function is called from tuner_probe you can be
- * certain no other devices will be added/deleted at the same time, I2C
- * core protects against that.
- */
- static void tuner_lookup(struct i2c_adapter *adap,
- struct tuner **radio, struct tuner **tv)
- {
- struct tuner *pos;
- *radio = NULL;
- *tv = NULL;
- list_for_each_entry(pos, &tuner_list, list) {
- int mode_mask;
- if (pos->i2c->adapter != adap ||
- strcmp(pos->i2c->dev.driver->name, "tuner"))
- continue;
- mode_mask = pos->mode_mask;
- if (*radio == NULL && mode_mask == T_RADIO)
- *radio = pos;
- /* Note: currently TDA9887 is the only demod-only
- device. If other devices appear then we need to
- make this test more general. */
- else if (*tv == NULL && pos->type != TUNER_TDA9887 &&
- (pos->mode_mask & T_ANALOG_TV))
- *tv = pos;
- }
- }
- /**
- *tuner_probe - Probes the existing tuners on an I2C bus
- *
- * @client: i2c_client descriptor
- * @id: not used
- *
- * This routine probes for tuners at the expected I2C addresses. On most
- * cases, if a device answers to a given I2C address, it assumes that the
- * device is a tuner. On a few cases, however, an additional logic is needed
- * to double check if the device is really a tuner, or to identify the tuner
- * type, like on tea5767/5761 devices.
- *
- * During client attach, set_type is called by adapter's attach_inform callback.
- * set_type must then be completed by tuner_probe.
- */
- static int tuner_probe(struct i2c_client *client,
- const struct i2c_device_id *id)
- {
- struct tuner *t;
- struct tuner *radio;
- struct tuner *tv;
- #ifdef CONFIG_MEDIA_CONTROLLER
- int ret;
- #endif
- t = kzalloc(sizeof(struct tuner), GFP_KERNEL);
- if (NULL == t)
- return -ENOMEM;
- v4l2_i2c_subdev_init(&t->sd, client, &tuner_ops);
- t->i2c = client;
- t->name = "(tuner unset)";
- t->type = UNSET;
- t->audmode = V4L2_TUNER_MODE_STEREO;
- t->standby = true;
- t->radio_freq = 87.5 * 16000; /* Initial freq range */
- t->tv_freq = 400 * 16; /* Sets freq to VHF High - needed for some PLL's to properly start */
- if (show_i2c) {
- unsigned char buffer[16];
- int rc;
- memset(buffer, 0, sizeof(buffer));
- rc = i2c_master_recv(client, buffer, sizeof(buffer));
- if (rc >= 0)
- pr_info("I2C RECV = %*ph\n", rc, buffer);
- }
- /* autodetection code based on the i2c addr */
- if (!no_autodetect) {
- switch (client->addr) {
- case 0x10:
- if (tuner_symbol_probe(tea5761_autodetection,
- t->i2c->adapter,
- t->i2c->addr) >= 0) {
- t->type = TUNER_TEA5761;
- t->mode_mask = T_RADIO;
- tuner_lookup(t->i2c->adapter, &radio, &tv);
- if (tv)
- tv->mode_mask &= ~T_RADIO;
- goto register_client;
- }
- kfree(t);
- return -ENODEV;
- case 0x42:
- case 0x43:
- case 0x4a:
- case 0x4b:
- /* If chip is not tda8290, don't register.
- since it can be tda9887*/
- if (tuner_symbol_probe(tda829x_probe, t->i2c->adapter,
- t->i2c->addr) >= 0) {
- dprintk("tda829x detected\n");
- } else {
- /* Default is being tda9887 */
- t->type = TUNER_TDA9887;
- t->mode_mask = T_RADIO | T_ANALOG_TV;
- goto register_client;
- }
- break;
- case 0x60:
- if (tuner_symbol_probe(tea5767_autodetection,
- t->i2c->adapter, t->i2c->addr)
- >= 0) {
- t->type = TUNER_TEA5767;
- t->mode_mask = T_RADIO;
- /* Sets freq to FM range */
- tuner_lookup(t->i2c->adapter, &radio, &tv);
- if (tv)
- tv->mode_mask &= ~T_RADIO;
- goto register_client;
- }
- break;
- }
- }
- /* Initializes only the first TV tuner on this adapter. Why only the
- first? Because there are some devices (notably the ones with TI
- tuners) that have more than one i2c address for the *same* device.
- Experience shows that, except for just one case, the first
- address is the right one. The exception is a Russian tuner
- (ACORP_Y878F). So, the desired behavior is just to enable the
- first found TV tuner. */
- tuner_lookup(t->i2c->adapter, &radio, &tv);
- if (tv == NULL) {
- t->mode_mask = T_ANALOG_TV;
- if (radio == NULL)
- t->mode_mask |= T_RADIO;
- dprintk("Setting mode_mask to 0x%02x\n", t->mode_mask);
- }
- /* Should be just before return */
- register_client:
- #if defined(CONFIG_MEDIA_CONTROLLER)
- t->sd.entity.name = t->name;
- /*
- * Handle the special case where the tuner has actually
- * two stages: the PLL to tune into a frequency and the
- * IF-PLL demodulator (tda988x).
- */
- if (t->type == TUNER_TDA9887) {
- t->pad[IF_VID_DEC_PAD_IF_INPUT].flags = MEDIA_PAD_FL_SINK;
- t->pad[IF_VID_DEC_PAD_OUT].flags = MEDIA_PAD_FL_SOURCE;
- ret = media_entity_pads_init(&t->sd.entity,
- IF_VID_DEC_PAD_NUM_PADS,
- &t->pad[0]);
- t->sd.entity.function = MEDIA_ENT_F_IF_VID_DECODER;
- } else {
- t->pad[TUNER_PAD_RF_INPUT].flags = MEDIA_PAD_FL_SINK;
- t->pad[TUNER_PAD_OUTPUT].flags = MEDIA_PAD_FL_SOURCE;
- t->pad[TUNER_PAD_AUD_OUT].flags = MEDIA_PAD_FL_SOURCE;
- ret = media_entity_pads_init(&t->sd.entity, TUNER_NUM_PADS,
- &t->pad[0]);
- t->sd.entity.function = MEDIA_ENT_F_TUNER;
- }
- if (ret < 0) {
- pr_err("failed to initialize media entity!\n");
- kfree(t);
- return ret;
- }
- #endif
- /* Sets a default mode */
- if (t->mode_mask & T_ANALOG_TV)
- t->mode = V4L2_TUNER_ANALOG_TV;
- else
- t->mode = V4L2_TUNER_RADIO;
- set_type(client, t->type, t->mode_mask, t->config, t->fe.callback);
- list_add_tail(&t->list, &tuner_list);
- pr_info("Tuner %d found with type(s)%s%s.\n",
- t->type,
- t->mode_mask & T_RADIO ? " Radio" : "",
- t->mode_mask & T_ANALOG_TV ? " TV" : "");
- return 0;
- }
- /**
- * tuner_remove - detaches a tuner
- *
- * @client: i2c_client descriptor
- */
- static int tuner_remove(struct i2c_client *client)
- {
- struct tuner *t = to_tuner(i2c_get_clientdata(client));
- v4l2_device_unregister_subdev(&t->sd);
- tuner_detach(&t->fe);
- t->fe.analog_demod_priv = NULL;
- list_del(&t->list);
- kfree(t);
- return 0;
- }
- /*
- * Functions to switch between Radio and TV
- *
- * A few cards have a separate I2C tuner for radio. Those routines
- * take care of switching between TV/Radio mode, filtering only the
- * commands that apply to the Radio or TV tuner.
- */
- /**
- * check_mode - Verify if tuner supports the requested mode
- * @t: a pointer to the module's internal struct_tuner
- * @mode: mode of the tuner, as defined by &enum v4l2_tuner_type.
- *
- * This function checks if the tuner is capable of tuning analog TV,
- * digital TV or radio, depending on what the caller wants. If the
- * tuner can't support that mode, it returns -EINVAL. Otherwise, it
- * returns 0.
- * This function is needed for boards that have a separate tuner for
- * radio (like devices with tea5767).
- *
- * NOTE: mt20xx uses V4L2_TUNER_DIGITAL_TV and calls set_tv_freq to
- * select a TV frequency. So, t_mode = T_ANALOG_TV could actually
- * be used to represent a Digital TV too.
- */
- static inline int check_mode(struct tuner *t, enum v4l2_tuner_type mode)
- {
- int t_mode;
- if (mode == V4L2_TUNER_RADIO)
- t_mode = T_RADIO;
- else
- t_mode = T_ANALOG_TV;
- if ((t_mode & t->mode_mask) == 0)
- return -EINVAL;
- return 0;
- }
- /**
- * set_mode - Switch tuner to other mode.
- * @t: a pointer to the module's internal struct_tuner
- * @mode: enum v4l2_type (radio or TV)
- *
- * If tuner doesn't support the needed mode (radio or TV), prints a
- * debug message and returns -EINVAL, changing its state to standby.
- * Otherwise, changes the mode and returns 0.
- */
- static int set_mode(struct tuner *t, enum v4l2_tuner_type mode)
- {
- struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
- if (mode != t->mode) {
- if (check_mode(t, mode) == -EINVAL) {
- dprintk("Tuner doesn't support mode %d. Putting tuner to sleep\n",
- mode);
- t->standby = true;
- if (analog_ops->standby)
- analog_ops->standby(&t->fe);
- return -EINVAL;
- }
- t->mode = mode;
- dprintk("Changing to mode %d\n", mode);
- }
- return 0;
- }
- /**
- * set_freq - Set the tuner to the desired frequency.
- * @t: a pointer to the module's internal struct_tuner
- * @freq: frequency to set (0 means to use the current frequency)
- */
- static void set_freq(struct tuner *t, unsigned int freq)
- {
- struct i2c_client *client = v4l2_get_subdevdata(&t->sd);
- if (t->mode == V4L2_TUNER_RADIO) {
- if (!freq)
- freq = t->radio_freq;
- set_radio_freq(client, freq);
- } else {
- if (!freq)
- freq = t->tv_freq;
- set_tv_freq(client, freq);
- }
- }
- /*
- * Functions that are specific for TV mode
- */
- /**
- * set_tv_freq - Set tuner frequency, freq in Units of 62.5 kHz = 1/16MHz
- *
- * @c: i2c_client descriptor
- * @freq: frequency
- */
- static void set_tv_freq(struct i2c_client *c, unsigned int freq)
- {
- struct tuner *t = to_tuner(i2c_get_clientdata(c));
- struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
- struct analog_parameters params = {
- .mode = t->mode,
- .audmode = t->audmode,
- .std = t->std
- };
- if (t->type == UNSET) {
- pr_warn("tuner type not set\n");
- return;
- }
- if (NULL == analog_ops->set_params) {
- pr_warn("Tuner has no way to set tv freq\n");
- return;
- }
- if (freq < tv_range[0] * 16 || freq > tv_range[1] * 16) {
- dprintk("TV freq (%d.%02d) out of range (%d-%d)\n",
- freq / 16, freq % 16 * 100 / 16, tv_range[0],
- tv_range[1]);
- /* V4L2 spec: if the freq is not possible then the closest
- possible value should be selected */
- if (freq < tv_range[0] * 16)
- freq = tv_range[0] * 16;
- else
- freq = tv_range[1] * 16;
- }
- params.frequency = freq;
- dprintk("tv freq set to %d.%02d\n",
- freq / 16, freq % 16 * 100 / 16);
- t->tv_freq = freq;
- t->standby = false;
- analog_ops->set_params(&t->fe, ¶ms);
- }
- /**
- * tuner_fixup_std - force a given video standard variant
- *
- * @t: tuner internal struct
- * @std: TV standard
- *
- * A few devices or drivers have problem to detect some standard variations.
- * On other operational systems, the drivers generally have a per-country
- * code, and some logic to apply per-country hacks. V4L2 API doesn't provide
- * such hacks. Instead, it relies on a proper video standard selection from
- * the userspace application. However, as some apps are buggy, not allowing
- * to distinguish all video standard variations, a modprobe parameter can
- * be used to force a video standard match.
- */
- static v4l2_std_id tuner_fixup_std(struct tuner *t, v4l2_std_id std)
- {
- if (pal[0] != '-' && (std & V4L2_STD_PAL) == V4L2_STD_PAL) {
- switch (pal[0]) {
- case '6':
- return V4L2_STD_PAL_60;
- case 'b':
- case 'B':
- case 'g':
- case 'G':
- return V4L2_STD_PAL_BG;
- case 'i':
- case 'I':
- return V4L2_STD_PAL_I;
- case 'd':
- case 'D':
- case 'k':
- case 'K':
- return V4L2_STD_PAL_DK;
- case 'M':
- case 'm':
- return V4L2_STD_PAL_M;
- case 'N':
- case 'n':
- if (pal[1] == 'c' || pal[1] == 'C')
- return V4L2_STD_PAL_Nc;
- return V4L2_STD_PAL_N;
- default:
- pr_warn("pal= argument not recognised\n");
- break;
- }
- }
- if (secam[0] != '-' && (std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
- switch (secam[0]) {
- case 'b':
- case 'B':
- case 'g':
- case 'G':
- case 'h':
- case 'H':
- return V4L2_STD_SECAM_B |
- V4L2_STD_SECAM_G |
- V4L2_STD_SECAM_H;
- case 'd':
- case 'D':
- case 'k':
- case 'K':
- return V4L2_STD_SECAM_DK;
- case 'l':
- case 'L':
- if ((secam[1] == 'C') || (secam[1] == 'c'))
- return V4L2_STD_SECAM_LC;
- return V4L2_STD_SECAM_L;
- default:
- pr_warn("secam= argument not recognised\n");
- break;
- }
- }
- if (ntsc[0] != '-' && (std & V4L2_STD_NTSC) == V4L2_STD_NTSC) {
- switch (ntsc[0]) {
- case 'm':
- case 'M':
- return V4L2_STD_NTSC_M;
- case 'j':
- case 'J':
- return V4L2_STD_NTSC_M_JP;
- case 'k':
- case 'K':
- return V4L2_STD_NTSC_M_KR;
- default:
- pr_info("ntsc= argument not recognised\n");
- break;
- }
- }
- return std;
- }
- /*
- * Functions that are specific for Radio mode
- */
- /**
- * set_radio_freq - Set tuner frequency, freq in Units of 62.5 Hz = 1/16kHz
- *
- * @c: i2c_client descriptor
- * @freq: frequency
- */
- static void set_radio_freq(struct i2c_client *c, unsigned int freq)
- {
- struct tuner *t = to_tuner(i2c_get_clientdata(c));
- struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
- struct analog_parameters params = {
- .mode = t->mode,
- .audmode = t->audmode,
- .std = t->std
- };
- if (t->type == UNSET) {
- pr_warn("tuner type not set\n");
- return;
- }
- if (NULL == analog_ops->set_params) {
- pr_warn("tuner has no way to set radio frequency\n");
- return;
- }
- if (freq < radio_range[0] * 16000 || freq > radio_range[1] * 16000) {
- dprintk("radio freq (%d.%02d) out of range (%d-%d)\n",
- freq / 16000, freq % 16000 * 100 / 16000,
- radio_range[0], radio_range[1]);
- /* V4L2 spec: if the freq is not possible then the closest
- possible value should be selected */
- if (freq < radio_range[0] * 16000)
- freq = radio_range[0] * 16000;
- else
- freq = radio_range[1] * 16000;
- }
- params.frequency = freq;
- dprintk("radio freq set to %d.%02d\n",
- freq / 16000, freq % 16000 * 100 / 16000);
- t->radio_freq = freq;
- t->standby = false;
- analog_ops->set_params(&t->fe, ¶ms);
- /*
- * The tuner driver might decide to change the audmode if it only
- * supports stereo, so update t->audmode.
- */
- t->audmode = params.audmode;
- }
- /*
- * Debug function for reporting tuner status to userspace
- */
- /**
- * tuner_status - Dumps the current tuner status at dmesg
- * @fe: pointer to struct dvb_frontend
- *
- * This callback is used only for driver debug purposes, answering to
- * VIDIOC_LOG_STATUS. No changes should happen on this call.
- */
- static void tuner_status(struct dvb_frontend *fe)
- {
- struct tuner *t = fe->analog_demod_priv;
- unsigned long freq, freq_fraction;
- struct dvb_tuner_ops *fe_tuner_ops = &fe->ops.tuner_ops;
- struct analog_demod_ops *analog_ops = &fe->ops.analog_ops;
- const char *p;
- switch (t->mode) {
- case V4L2_TUNER_RADIO:
- p = "radio";
- break;
- case V4L2_TUNER_DIGITAL_TV: /* Used by mt20xx */
- p = "digital TV";
- break;
- case V4L2_TUNER_ANALOG_TV:
- default:
- p = "analog TV";
- break;
- }
- if (t->mode == V4L2_TUNER_RADIO) {
- freq = t->radio_freq / 16000;
- freq_fraction = (t->radio_freq % 16000) * 100 / 16000;
- } else {
- freq = t->tv_freq / 16;
- freq_fraction = (t->tv_freq % 16) * 100 / 16;
- }
- pr_info("Tuner mode: %s%s\n", p,
- t->standby ? " on standby mode" : "");
- pr_info("Frequency: %lu.%02lu MHz\n", freq, freq_fraction);
- pr_info("Standard: 0x%08lx\n", (unsigned long)t->std);
- if (t->mode != V4L2_TUNER_RADIO)
- return;
- if (fe_tuner_ops->get_status) {
- u32 tuner_status;
- fe_tuner_ops->get_status(&t->fe, &tuner_status);
- if (tuner_status & TUNER_STATUS_LOCKED)
- pr_info("Tuner is locked.\n");
- if (tuner_status & TUNER_STATUS_STEREO)
- pr_info("Stereo: yes\n");
- }
- if (analog_ops->has_signal) {
- u16 signal;
- if (!analog_ops->has_signal(fe, &signal))
- pr_info("Signal strength: %hu\n", signal);
- }
- }
- /*
- * Function to splicitly change mode to radio. Probably not needed anymore
- */
- static int tuner_s_radio(struct v4l2_subdev *sd)
- {
- struct tuner *t = to_tuner(sd);
- if (set_mode(t, V4L2_TUNER_RADIO) == 0)
- set_freq(t, 0);
- return 0;
- }
- /*
- * Tuner callbacks to handle userspace ioctl's
- */
- /**
- * tuner_standby - places the tuner in standby mode
- * @sd: pointer to struct v4l2_subdev
- */
- static int tuner_standby(struct v4l2_subdev *sd)
- {
- struct tuner *t = to_tuner(sd);
- struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
- dprintk("Putting tuner to sleep\n");
- t->standby = true;
- if (analog_ops->standby)
- analog_ops->standby(&t->fe);
- return 0;
- }
- static int tuner_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
- {
- struct tuner *t = to_tuner(sd);
- if (set_mode(t, V4L2_TUNER_ANALOG_TV))
- return 0;
- t->std = tuner_fixup_std(t, std);
- if (t->std != std)
- dprintk("Fixup standard %llx to %llx\n", std, t->std);
- set_freq(t, 0);
- return 0;
- }
- static int tuner_s_frequency(struct v4l2_subdev *sd, const struct v4l2_frequency *f)
- {
- struct tuner *t = to_tuner(sd);
- if (set_mode(t, f->type) == 0)
- set_freq(t, f->frequency);
- return 0;
- }
- /**
- * tuner_g_frequency - Get the tuned frequency for the tuner
- * @sd: pointer to struct v4l2_subdev
- * @f: pointer to struct v4l2_frequency
- *
- * At return, the structure f will be filled with tuner frequency
- * if the tuner matches the f->type.
- * Note: f->type should be initialized before calling it.
- * This is done by either video_ioctl2 or by the bridge driver.
- */
- static int tuner_g_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *f)
- {
- struct tuner *t = to_tuner(sd);
- struct dvb_tuner_ops *fe_tuner_ops = &t->fe.ops.tuner_ops;
- if (check_mode(t, f->type) == -EINVAL)
- return 0;
- if (f->type == t->mode && fe_tuner_ops->get_frequency && !t->standby) {
- u32 abs_freq;
- fe_tuner_ops->get_frequency(&t->fe, &abs_freq);
- f->frequency = (V4L2_TUNER_RADIO == t->mode) ?
- DIV_ROUND_CLOSEST(abs_freq * 2, 125) :
- DIV_ROUND_CLOSEST(abs_freq, 62500);
- } else {
- f->frequency = (V4L2_TUNER_RADIO == f->type) ?
- t->radio_freq : t->tv_freq;
- }
- return 0;
- }
- /**
- * tuner_g_tuner - Fill in tuner information
- * @sd: pointer to struct v4l2_subdev
- * @vt: pointer to struct v4l2_tuner
- *
- * At return, the structure vt will be filled with tuner information
- * if the tuner matches vt->type.
- * Note: vt->type should be initialized before calling it.
- * This is done by either video_ioctl2 or by the bridge driver.
- */
- static int tuner_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
- {
- struct tuner *t = to_tuner(sd);
- struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
- struct dvb_tuner_ops *fe_tuner_ops = &t->fe.ops.tuner_ops;
- if (check_mode(t, vt->type) == -EINVAL)
- return 0;
- if (vt->type == t->mode && analog_ops->get_afc)
- analog_ops->get_afc(&t->fe, &vt->afc);
- if (vt->type == t->mode && analog_ops->has_signal) {
- u16 signal = (u16)vt->signal;
- if (!analog_ops->has_signal(&t->fe, &signal))
- vt->signal = signal;
- }
- if (vt->type != V4L2_TUNER_RADIO) {
- vt->capability |= V4L2_TUNER_CAP_NORM;
- vt->rangelow = tv_range[0] * 16;
- vt->rangehigh = tv_range[1] * 16;
- return 0;
- }
- /* radio mode */
- if (vt->type == t->mode) {
- vt->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
- if (fe_tuner_ops->get_status) {
- u32 tuner_status;
- fe_tuner_ops->get_status(&t->fe, &tuner_status);
- vt->rxsubchans =
- (tuner_status & TUNER_STATUS_STEREO) ?
- V4L2_TUNER_SUB_STEREO :
- V4L2_TUNER_SUB_MONO;
- }
- vt->audmode = t->audmode;
- }
- vt->capability |= V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO;
- vt->rangelow = radio_range[0] * 16000;
- vt->rangehigh = radio_range[1] * 16000;
- return 0;
- }
- /**
- * tuner_s_tuner - Set the tuner's audio mode
- * @sd: pointer to struct v4l2_subdev
- * @vt: pointer to struct v4l2_tuner
- *
- * Sets the audio mode if the tuner matches vt->type.
- * Note: vt->type should be initialized before calling it.
- * This is done by either video_ioctl2 or by the bridge driver.
- */
- static int tuner_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt)
- {
- struct tuner *t = to_tuner(sd);
- if (set_mode(t, vt->type))
- return 0;
- if (t->mode == V4L2_TUNER_RADIO) {
- t->audmode = vt->audmode;
- /*
- * For radio audmode can only be mono or stereo. Map any
- * other values to stereo. The actual tuner driver that is
- * called in set_radio_freq can decide to limit the audmode to
- * mono if only mono is supported.
- */
- if (t->audmode != V4L2_TUNER_MODE_MONO &&
- t->audmode != V4L2_TUNER_MODE_STEREO)
- t->audmode = V4L2_TUNER_MODE_STEREO;
- }
- set_freq(t, 0);
- return 0;
- }
- static int tuner_log_status(struct v4l2_subdev *sd)
- {
- struct tuner *t = to_tuner(sd);
- struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
- if (analog_ops->tuner_status)
- analog_ops->tuner_status(&t->fe);
- return 0;
- }
- #ifdef CONFIG_PM_SLEEP
- static int tuner_suspend(struct device *dev)
- {
- struct i2c_client *c = to_i2c_client(dev);
- struct tuner *t = to_tuner(i2c_get_clientdata(c));
- struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
- dprintk("suspend\n");
- if (t->fe.ops.tuner_ops.suspend)
- t->fe.ops.tuner_ops.suspend(&t->fe);
- else if (!t->standby && analog_ops->standby)
- analog_ops->standby(&t->fe);
- return 0;
- }
- static int tuner_resume(struct device *dev)
- {
- struct i2c_client *c = to_i2c_client(dev);
- struct tuner *t = to_tuner(i2c_get_clientdata(c));
- dprintk("resume\n");
- if (t->fe.ops.tuner_ops.resume)
- t->fe.ops.tuner_ops.resume(&t->fe);
- else if (!t->standby)
- if (set_mode(t, t->mode) == 0)
- set_freq(t, 0);
- return 0;
- }
- #endif
- static int tuner_command(struct i2c_client *client, unsigned cmd, void *arg)
- {
- struct v4l2_subdev *sd = i2c_get_clientdata(client);
- /* TUNER_SET_CONFIG is still called by tuner-simple.c, so we have
- to handle it here.
- There must be a better way of doing this... */
- switch (cmd) {
- case TUNER_SET_CONFIG:
- return tuner_s_config(sd, arg);
- }
- return -ENOIOCTLCMD;
- }
- /*
- * Callback structs
- */
- static const struct v4l2_subdev_core_ops tuner_core_ops = {
- .log_status = tuner_log_status,
- };
- static const struct v4l2_subdev_tuner_ops tuner_tuner_ops = {
- .standby = tuner_standby,
- .s_radio = tuner_s_radio,
- .g_tuner = tuner_g_tuner,
- .s_tuner = tuner_s_tuner,
- .s_frequency = tuner_s_frequency,
- .g_frequency = tuner_g_frequency,
- .s_type_addr = tuner_s_type_addr,
- .s_config = tuner_s_config,
- };
- static const struct v4l2_subdev_video_ops tuner_video_ops = {
- .s_std = tuner_s_std,
- };
- static const struct v4l2_subdev_ops tuner_ops = {
- .core = &tuner_core_ops,
- .tuner = &tuner_tuner_ops,
- .video = &tuner_video_ops,
- };
- /*
- * I2C structs and module init functions
- */
- static const struct dev_pm_ops tuner_pm_ops = {
- SET_SYSTEM_SLEEP_PM_OPS(tuner_suspend, tuner_resume)
- };
- static const struct i2c_device_id tuner_id[] = {
- { "tuner", }, /* autodetect */
- { }
- };
- MODULE_DEVICE_TABLE(i2c, tuner_id);
- static struct i2c_driver tuner_driver = {
- .driver = {
- .name = "tuner",
- .pm = &tuner_pm_ops,
- },
- .probe = tuner_probe,
- .remove = tuner_remove,
- .command = tuner_command,
- .id_table = tuner_id,
- };
- module_i2c_driver(tuner_driver);
- MODULE_DESCRIPTION("device driver for various TV and TV+FM radio tuners");
- MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer");
- MODULE_LICENSE("GPL");
|