tuner-core.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862
  1. /*
  2. *
  3. * i2c tv tuner chip device driver
  4. * core core, i.e. kernel interfaces, registering and so on
  5. */
  6. #include <linux/module.h>
  7. #include <linux/moduleparam.h>
  8. #include <linux/kernel.h>
  9. #include <linux/sched.h>
  10. #include <linux/string.h>
  11. #include <linux/timer.h>
  12. #include <linux/delay.h>
  13. #include <linux/errno.h>
  14. #include <linux/slab.h>
  15. #include <linux/poll.h>
  16. #include <linux/i2c.h>
  17. #include <linux/types.h>
  18. #include <linux/videodev.h>
  19. #include <linux/init.h>
  20. #include <media/tuner.h>
  21. #include <media/v4l2-common.h>
  22. #include <media/audiochip.h>
  23. #define UNSET (-1U)
  24. /* standard i2c insmod options */
  25. static unsigned short normal_i2c[] = {
  26. 0x42, 0x43, 0x4a, 0x4b, /* tda8290 */
  27. 0x60, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67,
  28. 0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f,
  29. I2C_CLIENT_END
  30. };
  31. I2C_CLIENT_INSMOD;
  32. /* insmod options used at init time => read/only */
  33. static unsigned int addr = 0;
  34. static unsigned int no_autodetect = 0;
  35. static unsigned int show_i2c = 0;
  36. /* insmod options used at runtime => read/write */
  37. static unsigned int tuner_debug_old = 0;
  38. int tuner_debug = 0;
  39. static unsigned int tv_range[2] = { 44, 958 };
  40. static unsigned int radio_range[2] = { 65, 108 };
  41. static char pal[] = "--";
  42. static char secam[] = "--";
  43. static char ntsc[] = "-";
  44. module_param(addr, int, 0444);
  45. module_param(no_autodetect, int, 0444);
  46. module_param(show_i2c, int, 0444);
  47. /* Note: tuner_debug is deprecated and will be removed in 2.6.17 */
  48. module_param_named(tuner_debug,tuner_debug_old, int, 0444);
  49. module_param_named(debug,tuner_debug, int, 0644);
  50. module_param_string(pal, pal, sizeof(pal), 0644);
  51. module_param_string(secam, secam, sizeof(secam), 0644);
  52. module_param_string(ntsc, ntsc, sizeof(ntsc), 0644);
  53. module_param_array(tv_range, int, NULL, 0644);
  54. module_param_array(radio_range, int, NULL, 0644);
  55. MODULE_DESCRIPTION("device driver for various TV and TV+FM radio tuners");
  56. MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer");
  57. MODULE_LICENSE("GPL");
  58. static struct i2c_driver driver;
  59. static struct i2c_client client_template;
  60. /* ---------------------------------------------------------------------- */
  61. /* Set tuner frequency, freq in Units of 62.5kHz = 1/16MHz */
  62. static void set_tv_freq(struct i2c_client *c, unsigned int freq)
  63. {
  64. struct tuner *t = i2c_get_clientdata(c);
  65. if (t->type == UNSET) {
  66. tuner_warn ("tuner type not set\n");
  67. return;
  68. }
  69. if (NULL == t->set_tv_freq) {
  70. tuner_warn ("Tuner has no way to set tv freq\n");
  71. return;
  72. }
  73. if (freq < tv_range[0] * 16 || freq > tv_range[1] * 16) {
  74. tuner_dbg ("TV freq (%d.%02d) out of range (%d-%d)\n",
  75. freq / 16, freq % 16 * 100 / 16, tv_range[0],
  76. tv_range[1]);
  77. /* V4L2 spec: if the freq is not possible then the closest
  78. possible value should be selected */
  79. if (freq < tv_range[0] * 16)
  80. freq = tv_range[0] * 16;
  81. else
  82. freq = tv_range[1] * 16;
  83. }
  84. t->set_tv_freq(c, freq);
  85. }
  86. static void set_radio_freq(struct i2c_client *c, unsigned int freq)
  87. {
  88. struct tuner *t = i2c_get_clientdata(c);
  89. if (t->type == UNSET) {
  90. tuner_warn ("tuner type not set\n");
  91. return;
  92. }
  93. if (NULL == t->set_radio_freq) {
  94. tuner_warn ("tuner has no way to set radio frequency\n");
  95. return;
  96. }
  97. if (freq < radio_range[0] * 16000 || freq > radio_range[1] * 16000) {
  98. tuner_dbg ("radio freq (%d.%02d) out of range (%d-%d)\n",
  99. freq / 16000, freq % 16000 * 100 / 16000,
  100. radio_range[0], radio_range[1]);
  101. /* V4L2 spec: if the freq is not possible then the closest
  102. possible value should be selected */
  103. if (freq < radio_range[0] * 16000)
  104. freq = radio_range[0] * 16000;
  105. else
  106. freq = radio_range[1] * 16000;
  107. }
  108. t->set_radio_freq(c, freq);
  109. }
  110. static void set_freq(struct i2c_client *c, unsigned long freq)
  111. {
  112. struct tuner *t = i2c_get_clientdata(c);
  113. switch (t->mode) {
  114. case V4L2_TUNER_RADIO:
  115. tuner_dbg("radio freq set to %lu.%02lu\n",
  116. freq / 16000, freq % 16000 * 100 / 16000);
  117. set_radio_freq(c, freq);
  118. t->radio_freq = freq;
  119. break;
  120. case V4L2_TUNER_ANALOG_TV:
  121. case V4L2_TUNER_DIGITAL_TV:
  122. tuner_dbg("tv freq set to %lu.%02lu\n",
  123. freq / 16, freq % 16 * 100 / 16);
  124. set_tv_freq(c, freq);
  125. t->tv_freq = freq;
  126. break;
  127. }
  128. }
  129. static void set_type(struct i2c_client *c, unsigned int type,
  130. unsigned int new_mode_mask)
  131. {
  132. struct tuner *t = i2c_get_clientdata(c);
  133. unsigned char buffer[4];
  134. if (type == UNSET || type == TUNER_ABSENT) {
  135. tuner_dbg ("tuner 0x%02x: Tuner type absent\n",c->addr);
  136. return;
  137. }
  138. if (type >= tuner_count) {
  139. tuner_warn ("tuner 0x%02x: Tuner count greater than %d\n",c->addr,tuner_count);
  140. return;
  141. }
  142. /* This code detects calls by card attach_inform */
  143. if (NULL == t->i2c.dev.driver) {
  144. tuner_dbg ("tuner 0x%02x: called during i2c_client register by adapter's attach_inform\n", c->addr);
  145. t->type=type;
  146. return;
  147. }
  148. t->type = type;
  149. switch (t->type) {
  150. case TUNER_MT2032:
  151. microtune_init(c);
  152. break;
  153. case TUNER_PHILIPS_TDA8290:
  154. tda8290_init(c);
  155. break;
  156. case TUNER_TEA5767:
  157. if (tea5767_tuner_init(c) == EINVAL) {
  158. t->type = TUNER_ABSENT;
  159. t->mode_mask = T_UNINITIALIZED;
  160. return;
  161. }
  162. t->mode_mask = T_RADIO;
  163. break;
  164. case TUNER_PHILIPS_FMD1216ME_MK3:
  165. buffer[0] = 0x0b;
  166. buffer[1] = 0xdc;
  167. buffer[2] = 0x9c;
  168. buffer[3] = 0x60;
  169. i2c_master_send(c, buffer, 4);
  170. mdelay(1);
  171. buffer[2] = 0x86;
  172. buffer[3] = 0x54;
  173. i2c_master_send(c, buffer, 4);
  174. default_tuner_init(c);
  175. break;
  176. case TUNER_LG_TDVS_H062F:
  177. /* Set the Auxiliary Byte. */
  178. buffer[2] &= ~0x20;
  179. buffer[2] |= 0x18;
  180. buffer[3] = 0x20;
  181. i2c_master_send(c, buffer, 4);
  182. default_tuner_init(c);
  183. break;
  184. case TUNER_PHILIPS_TD1316:
  185. buffer[0] = 0x0b;
  186. buffer[1] = 0xdc;
  187. buffer[2] = 0x86;
  188. buffer[3] = 0xa4;
  189. i2c_master_send(c,buffer,4);
  190. default_tuner_init(c);
  191. break;
  192. default:
  193. default_tuner_init(c);
  194. break;
  195. }
  196. if (t->mode_mask == T_UNINITIALIZED)
  197. t->mode_mask = new_mode_mask;
  198. set_freq(c, (V4L2_TUNER_RADIO == t->mode) ? t->radio_freq : t->tv_freq);
  199. tuner_dbg("%s %s I2C addr 0x%02x with type %d used for 0x%02x\n",
  200. c->adapter->name, c->driver->driver.name, c->addr << 1, type,
  201. t->mode_mask);
  202. }
  203. /*
  204. * This function apply tuner config to tuner specified
  205. * by tun_setup structure. I addr is unset, then admin status
  206. * and tun addr status is more precise then current status,
  207. * it's applied. Otherwise status and type are applied only to
  208. * tuner with exactly the same addr.
  209. */
  210. static void set_addr(struct i2c_client *c, struct tuner_setup *tun_setup)
  211. {
  212. struct tuner *t = i2c_get_clientdata(c);
  213. if ( t->type == UNSET && ((tun_setup->addr == ADDR_UNSET &&
  214. (t->mode_mask & tun_setup->mode_mask)) ||
  215. tun_setup->addr == c->addr)) {
  216. set_type(c, tun_setup->type, tun_setup->mode_mask);
  217. }
  218. }
  219. static inline int check_mode(struct tuner *t, char *cmd)
  220. {
  221. if ((1 << t->mode & t->mode_mask) == 0) {
  222. return EINVAL;
  223. }
  224. switch (t->mode) {
  225. case V4L2_TUNER_RADIO:
  226. tuner_dbg("Cmd %s accepted for radio\n", cmd);
  227. break;
  228. case V4L2_TUNER_ANALOG_TV:
  229. tuner_dbg("Cmd %s accepted for analog TV\n", cmd);
  230. break;
  231. case V4L2_TUNER_DIGITAL_TV:
  232. tuner_dbg("Cmd %s accepted for digital TV\n", cmd);
  233. break;
  234. }
  235. return 0;
  236. }
  237. /* get more precise norm info from insmod option */
  238. static int tuner_fixup_std(struct tuner *t)
  239. {
  240. if ((t->std & V4L2_STD_PAL) == V4L2_STD_PAL) {
  241. switch (pal[0]) {
  242. case 'b':
  243. case 'B':
  244. case 'g':
  245. case 'G':
  246. tuner_dbg ("insmod fixup: PAL => PAL-BG\n");
  247. t->std = V4L2_STD_PAL_BG;
  248. break;
  249. case 'i':
  250. case 'I':
  251. tuner_dbg ("insmod fixup: PAL => PAL-I\n");
  252. t->std = V4L2_STD_PAL_I;
  253. break;
  254. case 'd':
  255. case 'D':
  256. case 'k':
  257. case 'K':
  258. tuner_dbg ("insmod fixup: PAL => PAL-DK\n");
  259. t->std = V4L2_STD_PAL_DK;
  260. break;
  261. case 'M':
  262. case 'm':
  263. tuner_dbg ("insmod fixup: PAL => PAL-M\n");
  264. t->std = V4L2_STD_PAL_M;
  265. break;
  266. case 'N':
  267. case 'n':
  268. if (pal[1] == 'c' || pal[1] == 'C') {
  269. tuner_dbg("insmod fixup: PAL => PAL-Nc\n");
  270. t->std = V4L2_STD_PAL_Nc;
  271. } else {
  272. tuner_dbg ("insmod fixup: PAL => PAL-N\n");
  273. t->std = V4L2_STD_PAL_N;
  274. }
  275. break;
  276. case '-':
  277. /* default parameter, do nothing */
  278. break;
  279. default:
  280. tuner_warn ("pal= argument not recognised\n");
  281. break;
  282. }
  283. }
  284. if ((t->std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
  285. switch (secam[0]) {
  286. case 'b':
  287. case 'B':
  288. case 'g':
  289. case 'G':
  290. case 'h':
  291. case 'H':
  292. tuner_dbg("insmod fixup: SECAM => SECAM-BGH\n");
  293. t->std = V4L2_STD_SECAM_B | V4L2_STD_SECAM_G | V4L2_STD_SECAM_H;
  294. break;
  295. case 'd':
  296. case 'D':
  297. case 'k':
  298. case 'K':
  299. tuner_dbg ("insmod fixup: SECAM => SECAM-DK\n");
  300. t->std = V4L2_STD_SECAM_DK;
  301. break;
  302. case 'l':
  303. case 'L':
  304. if ((secam[1]=='C')||(secam[1]=='c')) {
  305. tuner_dbg ("insmod fixup: SECAM => SECAM-L'\n");
  306. t->std = V4L2_STD_SECAM_LC;
  307. } else {
  308. tuner_dbg ("insmod fixup: SECAM => SECAM-L\n");
  309. t->std = V4L2_STD_SECAM_L;
  310. }
  311. break;
  312. case '-':
  313. /* default parameter, do nothing */
  314. break;
  315. default:
  316. tuner_warn ("secam= argument not recognised\n");
  317. break;
  318. }
  319. }
  320. if ((t->std & V4L2_STD_NTSC) == V4L2_STD_NTSC) {
  321. switch (ntsc[0]) {
  322. case 'm':
  323. case 'M':
  324. tuner_dbg("insmod fixup: NTSC => NTSC-M\n");
  325. t->std = V4L2_STD_NTSC_M;
  326. break;
  327. case 'j':
  328. case 'J':
  329. tuner_dbg("insmod fixup: NTSC => NTSC_M_JP\n");
  330. t->std = V4L2_STD_NTSC_M_JP;
  331. break;
  332. case 'k':
  333. case 'K':
  334. tuner_dbg("insmod fixup: NTSC => NTSC_M_KR\n");
  335. t->std = V4L2_STD_NTSC_M_KR;
  336. break;
  337. case '-':
  338. /* default parameter, do nothing */
  339. break;
  340. default:
  341. tuner_info("ntsc= argument not recognised\n");
  342. break;
  343. }
  344. }
  345. return 0;
  346. }
  347. static void tuner_status(struct i2c_client *client)
  348. {
  349. struct tuner *t = i2c_get_clientdata(client);
  350. unsigned long freq, freq_fraction;
  351. const char *p;
  352. switch (t->mode) {
  353. case V4L2_TUNER_RADIO: p = "radio"; break;
  354. case V4L2_TUNER_ANALOG_TV: p = "analog TV"; break;
  355. case V4L2_TUNER_DIGITAL_TV: p = "digital TV"; break;
  356. default: p = "undefined"; break;
  357. }
  358. if (t->mode == V4L2_TUNER_RADIO) {
  359. freq = t->radio_freq / 16000;
  360. freq_fraction = (t->radio_freq % 16000) * 100 / 16000;
  361. } else {
  362. freq = t->tv_freq / 16;
  363. freq_fraction = (t->tv_freq % 16) * 100 / 16;
  364. }
  365. tuner_info("Tuner mode: %s\n", p);
  366. tuner_info("Frequency: %lu.%02lu MHz\n", freq, freq_fraction);
  367. tuner_info("Standard: 0x%08llx\n", t->std);
  368. if (t->mode == V4L2_TUNER_RADIO) {
  369. if (t->has_signal) {
  370. tuner_info("Signal strength: %d\n", t->has_signal(client));
  371. }
  372. if (t->is_stereo) {
  373. tuner_info("Stereo: %s\n", t->is_stereo(client) ? "yes" : "no");
  374. }
  375. }
  376. }
  377. /* ---------------------------------------------------------------------- */
  378. /* static var Used only in tuner_attach and tuner_probe */
  379. static unsigned default_mode_mask;
  380. /* During client attach, set_type is called by adapter's attach_inform callback.
  381. set_type must then be completed by tuner_attach.
  382. */
  383. static int tuner_attach(struct i2c_adapter *adap, int addr, int kind)
  384. {
  385. struct tuner *t;
  386. client_template.adapter = adap;
  387. client_template.addr = addr;
  388. t = kzalloc(sizeof(struct tuner), GFP_KERNEL);
  389. if (NULL == t)
  390. return -ENOMEM;
  391. memcpy(&t->i2c, &client_template, sizeof(struct i2c_client));
  392. i2c_set_clientdata(&t->i2c, t);
  393. t->type = UNSET;
  394. t->radio_if2 = 10700 * 1000; /* 10.7MHz - FM radio */
  395. t->audmode = V4L2_TUNER_MODE_STEREO;
  396. t->mode_mask = T_UNINITIALIZED;
  397. if (tuner_debug_old) {
  398. tuner_debug = tuner_debug_old;
  399. printk(KERN_ERR "tuner: tuner_debug is deprecated and will be removed in 2.6.17.\n");
  400. printk(KERN_ERR "tuner: use the debug option instead.\n");
  401. }
  402. if (show_i2c) {
  403. unsigned char buffer[16];
  404. int i,rc;
  405. memset(buffer, 0, sizeof(buffer));
  406. rc = i2c_master_recv(&t->i2c, buffer, sizeof(buffer));
  407. tuner_info("I2C RECV = ");
  408. for (i=0;i<rc;i++)
  409. printk("%02x ",buffer[i]);
  410. printk("\n");
  411. }
  412. /* autodetection code based on the i2c addr */
  413. if (!no_autodetect) {
  414. switch (addr) {
  415. case 0x42:
  416. case 0x43:
  417. case 0x4a:
  418. case 0x4b:
  419. /* If chip is not tda8290, don't register.
  420. since it can be tda9887*/
  421. if (tda8290_probe(&t->i2c) != 0) {
  422. tuner_dbg("chip at addr %x is not a tda8290\n", addr);
  423. kfree(t);
  424. return 0;
  425. }
  426. break;
  427. case 0x60:
  428. if (tea5767_autodetection(&t->i2c) != EINVAL) {
  429. t->type = TUNER_TEA5767;
  430. t->mode_mask = T_RADIO;
  431. t->mode = T_STANDBY;
  432. t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
  433. default_mode_mask &= ~T_RADIO;
  434. goto register_client;
  435. }
  436. break;
  437. }
  438. }
  439. /* Initializes only the first adapter found */
  440. if (default_mode_mask != T_UNINITIALIZED) {
  441. tuner_dbg ("Setting mode_mask to 0x%02x\n", default_mode_mask);
  442. t->mode_mask = default_mode_mask;
  443. t->tv_freq = 400 * 16; /* Sets freq to VHF High */
  444. t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
  445. default_mode_mask = T_UNINITIALIZED;
  446. }
  447. /* Should be just before return */
  448. register_client:
  449. tuner_info("chip found @ 0x%x (%s)\n", addr << 1, adap->name);
  450. i2c_attach_client (&t->i2c);
  451. set_type (&t->i2c,t->type, t->mode_mask);
  452. return 0;
  453. }
  454. static int tuner_probe(struct i2c_adapter *adap)
  455. {
  456. if (0 != addr) {
  457. normal_i2c[0] = addr;
  458. normal_i2c[1] = I2C_CLIENT_END;
  459. }
  460. default_mode_mask = T_RADIO | T_ANALOG_TV | T_DIGITAL_TV;
  461. if (adap->class & I2C_CLASS_TV_ANALOG)
  462. return i2c_probe(adap, &addr_data, tuner_attach);
  463. return 0;
  464. }
  465. static int tuner_detach(struct i2c_client *client)
  466. {
  467. struct tuner *t = i2c_get_clientdata(client);
  468. int err;
  469. err = i2c_detach_client(&t->i2c);
  470. if (err) {
  471. tuner_warn
  472. ("Client deregistration failed, client not detached.\n");
  473. return err;
  474. }
  475. kfree(t);
  476. return 0;
  477. }
  478. /*
  479. * Switch tuner to other mode. If tuner support both tv and radio,
  480. * set another frequency to some value (This is needed for some pal
  481. * tuners to avoid locking). Otherwise, just put second tuner in
  482. * standby mode.
  483. */
  484. static inline int set_mode(struct i2c_client *client, struct tuner *t, int mode, char *cmd)
  485. {
  486. if (mode == t->mode)
  487. return 0;
  488. t->mode = mode;
  489. if (check_mode(t, cmd) == EINVAL) {
  490. t->mode = T_STANDBY;
  491. if (t->standby)
  492. t->standby (client);
  493. return EINVAL;
  494. }
  495. return 0;
  496. }
  497. #define switch_v4l2() if (!t->using_v4l2) \
  498. tuner_dbg("switching to v4l2\n"); \
  499. t->using_v4l2 = 1;
  500. static inline int check_v4l2(struct tuner *t)
  501. {
  502. if (t->using_v4l2) {
  503. tuner_dbg ("ignore v4l1 call\n");
  504. return EINVAL;
  505. }
  506. return 0;
  507. }
  508. static int tuner_command(struct i2c_client *client, unsigned int cmd, void *arg)
  509. {
  510. struct tuner *t = i2c_get_clientdata(client);
  511. if (tuner_debug>1)
  512. v4l_i2c_print_ioctl(&(t->i2c),cmd);
  513. switch (cmd) {
  514. /* --- configuration --- */
  515. case TUNER_SET_TYPE_ADDR:
  516. tuner_dbg ("Calling set_type_addr for type=%d, addr=0x%02x, mode=0x%02x\n",
  517. ((struct tuner_setup *)arg)->type,
  518. ((struct tuner_setup *)arg)->addr,
  519. ((struct tuner_setup *)arg)->mode_mask);
  520. set_addr(client, (struct tuner_setup *)arg);
  521. break;
  522. case AUDC_SET_RADIO:
  523. if (set_mode(client, t, V4L2_TUNER_RADIO, "AUDC_SET_RADIO")
  524. == EINVAL)
  525. return 0;
  526. if (t->radio_freq)
  527. set_freq(client, t->radio_freq);
  528. break;
  529. case TUNER_SET_STANDBY:
  530. if (check_mode(t, "TUNER_SET_STANDBY") == EINVAL)
  531. return 0;
  532. if (t->standby)
  533. t->standby (client);
  534. break;
  535. case VIDIOCSAUDIO:
  536. if (check_mode(t, "VIDIOCSAUDIO") == EINVAL)
  537. return 0;
  538. if (check_v4l2(t) == EINVAL)
  539. return 0;
  540. /* Should be implemented, since bttv calls it */
  541. tuner_dbg("VIDIOCSAUDIO not implemented.\n");
  542. break;
  543. /* --- v4l ioctls --- */
  544. /* take care: bttv does userspace copying, we'll get a
  545. kernel pointer here... */
  546. case VIDIOCSCHAN:
  547. {
  548. static const v4l2_std_id map[] = {
  549. [VIDEO_MODE_PAL] = V4L2_STD_PAL,
  550. [VIDEO_MODE_NTSC] = V4L2_STD_NTSC_M,
  551. [VIDEO_MODE_SECAM] = V4L2_STD_SECAM,
  552. [4 /* bttv */ ] = V4L2_STD_PAL_M,
  553. [5 /* bttv */ ] = V4L2_STD_PAL_N,
  554. [6 /* bttv */ ] = V4L2_STD_NTSC_M_JP,
  555. };
  556. struct video_channel *vc = arg;
  557. if (check_v4l2(t) == EINVAL)
  558. return 0;
  559. if (set_mode(client,t,V4L2_TUNER_ANALOG_TV, "VIDIOCSCHAN")==EINVAL)
  560. return 0;
  561. if (vc->norm < ARRAY_SIZE(map))
  562. t->std = map[vc->norm];
  563. tuner_fixup_std(t);
  564. if (t->tv_freq)
  565. set_tv_freq(client, t->tv_freq);
  566. return 0;
  567. }
  568. case VIDIOCSFREQ:
  569. {
  570. unsigned long *v = arg;
  571. if (check_mode(t, "VIDIOCSFREQ") == EINVAL)
  572. return 0;
  573. if (check_v4l2(t) == EINVAL)
  574. return 0;
  575. set_freq(client, *v);
  576. return 0;
  577. }
  578. case VIDIOCGTUNER:
  579. {
  580. struct video_tuner *vt = arg;
  581. if (check_mode(t, "VIDIOCGTUNER") == EINVAL)
  582. return 0;
  583. if (check_v4l2(t) == EINVAL)
  584. return 0;
  585. if (V4L2_TUNER_RADIO == t->mode) {
  586. if (t->has_signal)
  587. vt->signal = t->has_signal(client);
  588. if (t->is_stereo) {
  589. if (t->is_stereo(client))
  590. vt->flags |=
  591. VIDEO_TUNER_STEREO_ON;
  592. else
  593. vt->flags &=
  594. ~VIDEO_TUNER_STEREO_ON;
  595. }
  596. vt->flags |= VIDEO_TUNER_LOW; /* Allow freqs at 62.5 Hz */
  597. vt->rangelow = radio_range[0] * 16000;
  598. vt->rangehigh = radio_range[1] * 16000;
  599. } else {
  600. vt->rangelow = tv_range[0] * 16;
  601. vt->rangehigh = tv_range[1] * 16;
  602. }
  603. return 0;
  604. }
  605. case VIDIOCGAUDIO:
  606. {
  607. struct video_audio *va = arg;
  608. if (check_mode(t, "VIDIOCGAUDIO") == EINVAL)
  609. return 0;
  610. if (check_v4l2(t) == EINVAL)
  611. return 0;
  612. if (V4L2_TUNER_RADIO == t->mode && t->is_stereo)
  613. va->mode = t->is_stereo(client)
  614. ? VIDEO_SOUND_STEREO : VIDEO_SOUND_MONO;
  615. return 0;
  616. }
  617. case VIDIOC_S_STD:
  618. {
  619. v4l2_std_id *id = arg;
  620. if (set_mode (client, t, V4L2_TUNER_ANALOG_TV, "VIDIOC_S_STD")
  621. == EINVAL)
  622. return 0;
  623. switch_v4l2();
  624. t->std = *id;
  625. tuner_fixup_std(t);
  626. if (t->tv_freq)
  627. set_freq(client, t->tv_freq);
  628. break;
  629. }
  630. case VIDIOC_S_FREQUENCY:
  631. {
  632. struct v4l2_frequency *f = arg;
  633. switch_v4l2();
  634. if ((V4L2_TUNER_RADIO == f->type && V4L2_TUNER_RADIO != t->mode)
  635. || (V4L2_TUNER_DIGITAL_TV == f->type
  636. && V4L2_TUNER_DIGITAL_TV != t->mode)) {
  637. if (set_mode (client, t, f->type, "VIDIOC_S_FREQUENCY")
  638. == EINVAL)
  639. return 0;
  640. }
  641. set_freq(client,f->frequency);
  642. break;
  643. }
  644. case VIDIOC_G_FREQUENCY:
  645. {
  646. struct v4l2_frequency *f = arg;
  647. if (check_mode(t, "VIDIOC_G_FREQUENCY") == EINVAL)
  648. return 0;
  649. switch_v4l2();
  650. f->type = t->mode;
  651. f->frequency = (V4L2_TUNER_RADIO == t->mode) ?
  652. t->radio_freq : t->tv_freq;
  653. break;
  654. }
  655. case VIDIOC_G_TUNER:
  656. {
  657. struct v4l2_tuner *tuner = arg;
  658. if (check_mode(t, "VIDIOC_G_TUNER") == EINVAL)
  659. return 0;
  660. switch_v4l2();
  661. if (V4L2_TUNER_RADIO == t->mode) {
  662. if (t->has_signal)
  663. tuner->signal = t->has_signal(client);
  664. if (t->is_stereo) {
  665. if (t->is_stereo(client)) {
  666. tuner->rxsubchans =
  667. V4L2_TUNER_SUB_STEREO |
  668. V4L2_TUNER_SUB_MONO;
  669. } else {
  670. tuner->rxsubchans =
  671. V4L2_TUNER_SUB_MONO;
  672. }
  673. }
  674. tuner->capability |=
  675. V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO;
  676. tuner->audmode = t->audmode;
  677. tuner->rangelow = radio_range[0] * 16000;
  678. tuner->rangehigh = radio_range[1] * 16000;
  679. } else {
  680. tuner->rangelow = tv_range[0] * 16;
  681. tuner->rangehigh = tv_range[1] * 16;
  682. }
  683. break;
  684. }
  685. case VIDIOC_S_TUNER:
  686. {
  687. struct v4l2_tuner *tuner = arg;
  688. if (check_mode(t, "VIDIOC_S_TUNER") == EINVAL)
  689. return 0;
  690. switch_v4l2();
  691. if (V4L2_TUNER_RADIO == t->mode) {
  692. t->audmode = tuner->audmode;
  693. set_radio_freq(client, t->radio_freq);
  694. }
  695. break;
  696. }
  697. case VIDIOC_LOG_STATUS:
  698. tuner_status(client);
  699. break;
  700. }
  701. return 0;
  702. }
  703. static int tuner_suspend(struct device *dev, pm_message_t state)
  704. {
  705. struct i2c_client *c = container_of (dev, struct i2c_client, dev);
  706. struct tuner *t = i2c_get_clientdata (c);
  707. tuner_dbg ("suspend\n");
  708. /* FIXME: power down ??? */
  709. return 0;
  710. }
  711. static int tuner_resume(struct device *dev)
  712. {
  713. struct i2c_client *c = container_of (dev, struct i2c_client, dev);
  714. struct tuner *t = i2c_get_clientdata (c);
  715. tuner_dbg ("resume\n");
  716. if (V4L2_TUNER_RADIO == t->mode) {
  717. if (t->radio_freq)
  718. set_freq(c, t->radio_freq);
  719. } else {
  720. if (t->tv_freq)
  721. set_freq(c, t->tv_freq);
  722. }
  723. return 0;
  724. }
  725. /* ----------------------------------------------------------------------- */
  726. static struct i2c_driver driver = {
  727. .id = I2C_DRIVERID_TUNER,
  728. .attach_adapter = tuner_probe,
  729. .detach_client = tuner_detach,
  730. .command = tuner_command,
  731. .driver = {
  732. .name = "tuner",
  733. .suspend = tuner_suspend,
  734. .resume = tuner_resume,
  735. },
  736. };
  737. static struct i2c_client client_template = {
  738. .name = "(tuner unset)",
  739. .driver = &driver,
  740. };
  741. static int __init tuner_init_module(void)
  742. {
  743. return i2c_add_driver(&driver);
  744. }
  745. static void __exit tuner_cleanup_module(void)
  746. {
  747. i2c_del_driver(&driver);
  748. }
  749. module_init(tuner_init_module);
  750. module_exit(tuner_cleanup_module);
  751. /*
  752. * Overrides for Emacs so that we follow Linus's tabbing style.
  753. * ---------------------------------------------------------------------------
  754. * Local variables:
  755. * c-basic-offset: 8
  756. * End:
  757. */