saa7134-tvaudio.c 28 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077
  1. /*
  2. *
  3. * device driver for philips saa7134 based TV cards
  4. * tv audio decoder (fm stereo, nicam, ...)
  5. *
  6. * (c) 2001-03 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. */
  18. #include "saa7134.h"
  19. #include "saa7134-reg.h"
  20. #include <linux/init.h>
  21. #include <linux/list.h>
  22. #include <linux/module.h>
  23. #include <linux/kernel.h>
  24. #include <linux/kthread.h>
  25. #include <linux/delay.h>
  26. #include <linux/freezer.h>
  27. #include <asm/div64.h>
  28. /* ------------------------------------------------------------------ */
  29. static unsigned int audio_debug;
  30. module_param(audio_debug, int, 0644);
  31. MODULE_PARM_DESC(audio_debug,"enable debug messages [tv audio]");
  32. static unsigned int audio_ddep;
  33. module_param(audio_ddep, int, 0644);
  34. MODULE_PARM_DESC(audio_ddep,"audio ddep overwrite");
  35. static int audio_clock_override = UNSET;
  36. module_param(audio_clock_override, int, 0644);
  37. static int audio_clock_tweak;
  38. module_param(audio_clock_tweak, int, 0644);
  39. MODULE_PARM_DESC(audio_clock_tweak, "Audio clock tick fine tuning for cards with audio crystal that's slightly off (range [-1024 .. 1024])");
  40. #define audio_dbg(level, fmt, arg...) do { \
  41. if (audio_debug >= level) \
  42. printk(KERN_DEBUG pr_fmt("audio: " fmt), ## arg); \
  43. } while (0)
  44. /* msecs */
  45. #define SCAN_INITIAL_DELAY 1000
  46. #define SCAN_SAMPLE_DELAY 200
  47. #define SCAN_SUBCARRIER_DELAY 2000
  48. /* ------------------------------------------------------------------ */
  49. /* saa7134 code */
  50. static struct mainscan {
  51. char *name;
  52. v4l2_std_id std;
  53. int carr;
  54. } mainscan[] = {
  55. {
  56. .name = "MN",
  57. .std = V4L2_STD_MN,
  58. .carr = 4500,
  59. },{
  60. .name = "BGH",
  61. .std = V4L2_STD_B | V4L2_STD_GH,
  62. .carr = 5500,
  63. },{
  64. .name = "I",
  65. .std = V4L2_STD_PAL_I,
  66. .carr = 6000,
  67. },{
  68. .name = "DKL",
  69. .std = V4L2_STD_DK | V4L2_STD_SECAM_L | V4L2_STD_SECAM_LC,
  70. .carr = 6500,
  71. }
  72. };
  73. static struct saa7134_tvaudio tvaudio[] = {
  74. {
  75. .name = "PAL-B/G FM-stereo",
  76. .std = V4L2_STD_PAL_BG,
  77. .mode = TVAUDIO_FM_BG_STEREO,
  78. .carr1 = 5500,
  79. .carr2 = 5742,
  80. },{
  81. .name = "PAL-D/K1 FM-stereo",
  82. .std = V4L2_STD_PAL_DK,
  83. .carr1 = 6500,
  84. .carr2 = 6258,
  85. .mode = TVAUDIO_FM_BG_STEREO,
  86. },{
  87. .name = "PAL-D/K2 FM-stereo",
  88. .std = V4L2_STD_PAL_DK,
  89. .carr1 = 6500,
  90. .carr2 = 6742,
  91. .mode = TVAUDIO_FM_BG_STEREO,
  92. },{
  93. .name = "PAL-D/K3 FM-stereo",
  94. .std = V4L2_STD_PAL_DK,
  95. .carr1 = 6500,
  96. .carr2 = 5742,
  97. .mode = TVAUDIO_FM_BG_STEREO,
  98. },{
  99. .name = "PAL-B/G NICAM",
  100. .std = V4L2_STD_PAL_BG,
  101. .carr1 = 5500,
  102. .carr2 = 5850,
  103. .mode = TVAUDIO_NICAM_FM,
  104. },{
  105. .name = "PAL-I NICAM",
  106. .std = V4L2_STD_PAL_I,
  107. .carr1 = 6000,
  108. .carr2 = 6552,
  109. .mode = TVAUDIO_NICAM_FM,
  110. },{
  111. .name = "PAL-D/K NICAM",
  112. .std = V4L2_STD_PAL_DK,
  113. .carr1 = 6500,
  114. .carr2 = 5850,
  115. .mode = TVAUDIO_NICAM_FM,
  116. },{
  117. .name = "SECAM-L NICAM",
  118. .std = V4L2_STD_SECAM_L,
  119. .carr1 = 6500,
  120. .carr2 = 5850,
  121. .mode = TVAUDIO_NICAM_AM,
  122. },{
  123. .name = "SECAM-D/K NICAM",
  124. .std = V4L2_STD_SECAM_DK,
  125. .carr1 = 6500,
  126. .carr2 = 5850,
  127. .mode = TVAUDIO_NICAM_FM,
  128. },{
  129. .name = "NTSC-A2 FM-stereo",
  130. .std = V4L2_STD_NTSC,
  131. .carr1 = 4500,
  132. .carr2 = 4724,
  133. .mode = TVAUDIO_FM_K_STEREO,
  134. },{
  135. .name = "NTSC-M",
  136. .std = V4L2_STD_NTSC,
  137. .carr1 = 4500,
  138. .carr2 = -1,
  139. .mode = TVAUDIO_FM_MONO,
  140. }
  141. };
  142. #define TVAUDIO ARRAY_SIZE(tvaudio)
  143. /* ------------------------------------------------------------------ */
  144. static u32 tvaudio_carr2reg(u32 carrier)
  145. {
  146. u64 a = carrier;
  147. a <<= 24;
  148. do_div(a,12288);
  149. return a;
  150. }
  151. static void tvaudio_setcarrier(struct saa7134_dev *dev,
  152. int primary, int secondary)
  153. {
  154. if (-1 == secondary)
  155. secondary = primary;
  156. saa_writel(SAA7134_CARRIER1_FREQ0 >> 2, tvaudio_carr2reg(primary));
  157. saa_writel(SAA7134_CARRIER2_FREQ0 >> 2, tvaudio_carr2reg(secondary));
  158. }
  159. #define SAA7134_MUTE_MASK 0xbb
  160. #define SAA7134_MUTE_ANALOG 0x04
  161. #define SAA7134_MUTE_I2S 0x40
  162. static void mute_input_7134(struct saa7134_dev *dev)
  163. {
  164. unsigned int mute;
  165. struct saa7134_input *in;
  166. int ausel=0, ics=0, ocs=0;
  167. int mask;
  168. /* look what is to do ... */
  169. in = dev->input;
  170. mute = (dev->ctl_mute ||
  171. (dev->automute && (&card(dev).radio) != in));
  172. if (card(dev).mute.type) {
  173. /*
  174. * 7130 - we'll mute using some unconnected audio input
  175. * 7134 - we'll probably should switch external mux with gpio
  176. */
  177. if (mute)
  178. in = &card(dev).mute;
  179. }
  180. if (dev->hw_mute == mute &&
  181. dev->hw_input == in && !dev->insuspend) {
  182. audio_dbg(1, "mute/input: nothing to do [mute=%d,input=%s]\n",
  183. mute, saa7134_input_name[in->type]);
  184. return;
  185. }
  186. audio_dbg(1, "ctl_mute=%d automute=%d input=%s => mute=%d input=%s\n",
  187. dev->ctl_mute, dev->automute,
  188. saa7134_input_name[dev->input->type], mute,
  189. saa7134_input_name[in->type]);
  190. dev->hw_mute = mute;
  191. dev->hw_input = in;
  192. if (PCI_DEVICE_ID_PHILIPS_SAA7134 == dev->pci->device)
  193. /* 7134 mute */
  194. saa_writeb(SAA7134_AUDIO_MUTE_CTRL, mute ?
  195. SAA7134_MUTE_MASK |
  196. SAA7134_MUTE_ANALOG |
  197. SAA7134_MUTE_I2S :
  198. SAA7134_MUTE_MASK);
  199. /* switch internal audio mux */
  200. switch (in->amux) {
  201. case TV: ausel=0xc0; ics=0x00; ocs=0x02; break;
  202. case LINE1: ausel=0x80; ics=0x00; ocs=0x00; break;
  203. case LINE2: ausel=0x80; ics=0x08; ocs=0x01; break;
  204. case LINE2_LEFT: ausel=0x80; ics=0x08; ocs=0x05; break;
  205. }
  206. saa_andorb(SAA7134_AUDIO_FORMAT_CTRL, 0xc0, ausel);
  207. saa_andorb(SAA7134_ANALOG_IO_SELECT, 0x08, ics);
  208. saa_andorb(SAA7134_ANALOG_IO_SELECT, 0x07, ocs);
  209. // for oss, we need to change the clock configuration
  210. if (in->amux == TV)
  211. saa_andorb(SAA7134_SIF_SAMPLE_FREQ, 0x03, 0x00);
  212. else
  213. saa_andorb(SAA7134_SIF_SAMPLE_FREQ, 0x03, 0x01);
  214. /* switch gpio-connected external audio mux */
  215. if (0 == card(dev).gpiomask)
  216. return;
  217. mask = card(dev).gpiomask;
  218. saa_andorl(SAA7134_GPIO_GPMODE0 >> 2, mask, mask);
  219. saa_andorl(SAA7134_GPIO_GPSTATUS0 >> 2, mask, in->gpio);
  220. saa7134_track_gpio(dev, saa7134_input_name[in->type]);
  221. }
  222. static void tvaudio_setmode(struct saa7134_dev *dev,
  223. struct saa7134_tvaudio *audio,
  224. char *note)
  225. {
  226. int acpf, tweak = 0;
  227. if (dev->tvnorm->id == V4L2_STD_NTSC) {
  228. acpf = 0x19066;
  229. } else {
  230. acpf = 0x1e000;
  231. }
  232. if (audio_clock_tweak > -1024 && audio_clock_tweak < 1024)
  233. tweak = audio_clock_tweak;
  234. if (note)
  235. audio_dbg(1, "tvaudio_setmode: %s %s [%d.%03d/%d.%03d MHz] acpf=%d%+d\n",
  236. note, audio->name,
  237. audio->carr1 / 1000, audio->carr1 % 1000,
  238. audio->carr2 / 1000, audio->carr2 % 1000,
  239. acpf, tweak);
  240. acpf += tweak;
  241. saa_writeb(SAA7134_AUDIO_CLOCKS_PER_FIELD0, (acpf & 0x0000ff) >> 0);
  242. saa_writeb(SAA7134_AUDIO_CLOCKS_PER_FIELD1, (acpf & 0x00ff00) >> 8);
  243. saa_writeb(SAA7134_AUDIO_CLOCKS_PER_FIELD2, (acpf & 0x030000) >> 16);
  244. tvaudio_setcarrier(dev,audio->carr1,audio->carr2);
  245. switch (audio->mode) {
  246. case TVAUDIO_FM_MONO:
  247. case TVAUDIO_FM_BG_STEREO:
  248. saa_writeb(SAA7134_DEMODULATOR, 0x00);
  249. saa_writeb(SAA7134_DCXO_IDENT_CTRL, 0x00);
  250. saa_writeb(SAA7134_FM_DEEMPHASIS, 0x22);
  251. saa_writeb(SAA7134_FM_DEMATRIX, 0x80);
  252. saa_writeb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0xa0);
  253. break;
  254. case TVAUDIO_FM_K_STEREO:
  255. saa_writeb(SAA7134_DEMODULATOR, 0x00);
  256. saa_writeb(SAA7134_DCXO_IDENT_CTRL, 0x01);
  257. saa_writeb(SAA7134_FM_DEEMPHASIS, 0x22);
  258. saa_writeb(SAA7134_FM_DEMATRIX, 0x80);
  259. saa_writeb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0xa0);
  260. break;
  261. case TVAUDIO_NICAM_FM:
  262. saa_writeb(SAA7134_DEMODULATOR, 0x10);
  263. saa_writeb(SAA7134_DCXO_IDENT_CTRL, 0x00);
  264. saa_writeb(SAA7134_FM_DEEMPHASIS, 0x44);
  265. saa_writeb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0xa1);
  266. saa_writeb(SAA7134_NICAM_CONFIG, 0x00);
  267. break;
  268. case TVAUDIO_NICAM_AM:
  269. saa_writeb(SAA7134_DEMODULATOR, 0x12);
  270. saa_writeb(SAA7134_DCXO_IDENT_CTRL, 0x00);
  271. saa_writeb(SAA7134_FM_DEEMPHASIS, 0x44);
  272. saa_writeb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0xa1);
  273. saa_writeb(SAA7134_NICAM_CONFIG, 0x00);
  274. break;
  275. case TVAUDIO_FM_SAT_STEREO:
  276. /* not implemented (yet) */
  277. break;
  278. }
  279. }
  280. static int tvaudio_sleep(struct saa7134_dev *dev, int timeout)
  281. {
  282. if (dev->thread.scan1 == dev->thread.scan2 &&
  283. !kthread_should_stop()) {
  284. if (timeout < 0) {
  285. set_current_state(TASK_INTERRUPTIBLE);
  286. schedule();
  287. } else {
  288. schedule_timeout_interruptible
  289. (msecs_to_jiffies(timeout));
  290. }
  291. }
  292. return dev->thread.scan1 != dev->thread.scan2;
  293. }
  294. static int tvaudio_checkcarrier(struct saa7134_dev *dev, struct mainscan *scan)
  295. {
  296. __s32 left,right,value;
  297. if (!(dev->tvnorm->id & scan->std)) {
  298. value = 0;
  299. audio_dbg(1, "skipping %d.%03d MHz [%4s]\n",
  300. scan->carr / 1000, scan->carr % 1000, scan->name);
  301. return 0;
  302. }
  303. if (audio_debug > 1) {
  304. int i;
  305. audio_dbg(1, "debug %d:", scan->carr);
  306. for (i = -150; i <= 150; i += 30) {
  307. tvaudio_setcarrier(dev,scan->carr+i,scan->carr+i);
  308. saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
  309. if (tvaudio_sleep(dev,SCAN_SAMPLE_DELAY))
  310. return -1;
  311. value = saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
  312. if (0 == i)
  313. pr_cont(" # %6d # ", value >> 16);
  314. else
  315. pr_cont(" %6d", value >> 16);
  316. }
  317. pr_cont("\n");
  318. }
  319. tvaudio_setcarrier(dev,scan->carr-90,scan->carr-90);
  320. saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
  321. if (tvaudio_sleep(dev,SCAN_SAMPLE_DELAY))
  322. return -1;
  323. left = saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
  324. tvaudio_setcarrier(dev,scan->carr+90,scan->carr+90);
  325. saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
  326. if (tvaudio_sleep(dev,SCAN_SAMPLE_DELAY))
  327. return -1;
  328. right = saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
  329. left >>= 16;
  330. right >>= 16;
  331. value = left > right ? left - right : right - left;
  332. audio_dbg(1, "scanning %d.%03d MHz [%4s] => dc is %5d [%d/%d]\n",
  333. scan->carr / 1000, scan->carr % 1000,
  334. scan->name, value, left, right);
  335. return value;
  336. }
  337. static int tvaudio_getstereo(struct saa7134_dev *dev, struct saa7134_tvaudio *audio)
  338. {
  339. __u32 idp, nicam, nicam_status;
  340. int retval = -1;
  341. switch (audio->mode) {
  342. case TVAUDIO_FM_MONO:
  343. return V4L2_TUNER_SUB_MONO;
  344. case TVAUDIO_FM_K_STEREO:
  345. case TVAUDIO_FM_BG_STEREO:
  346. idp = (saa_readb(SAA7134_IDENT_SIF) & 0xe0) >> 5;
  347. audio_dbg(1, "getstereo: fm/stereo: idp=0x%x\n", idp);
  348. if (0x03 == (idp & 0x03))
  349. retval = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
  350. else if (0x05 == (idp & 0x05))
  351. retval = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
  352. else if (0x01 == (idp & 0x01))
  353. retval = V4L2_TUNER_SUB_MONO;
  354. break;
  355. case TVAUDIO_FM_SAT_STEREO:
  356. /* not implemented (yet) */
  357. break;
  358. case TVAUDIO_NICAM_FM:
  359. case TVAUDIO_NICAM_AM:
  360. nicam = saa_readb(SAA7134_AUDIO_STATUS);
  361. audio_dbg(1, "getstereo: nicam=0x%x\n", nicam);
  362. if (nicam & 0x1) {
  363. nicam_status = saa_readb(SAA7134_NICAM_STATUS);
  364. audio_dbg(1, "getstereo: nicam_status=0x%x\n",
  365. nicam_status);
  366. switch (nicam_status & 0x03) {
  367. case 0x01:
  368. retval = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
  369. break;
  370. case 0x02:
  371. retval = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
  372. break;
  373. default:
  374. retval = V4L2_TUNER_SUB_MONO;
  375. }
  376. } else {
  377. /* No nicam detected */
  378. }
  379. break;
  380. }
  381. if (retval != -1)
  382. audio_dbg(1, "found audio subchannels:%s%s%s%s\n",
  383. (retval & V4L2_TUNER_SUB_MONO) ? " mono" : "",
  384. (retval & V4L2_TUNER_SUB_STEREO) ? " stereo" : "",
  385. (retval & V4L2_TUNER_SUB_LANG1) ? " lang1" : "",
  386. (retval & V4L2_TUNER_SUB_LANG2) ? " lang2" : "");
  387. return retval;
  388. }
  389. static int tvaudio_setstereo(struct saa7134_dev *dev, struct saa7134_tvaudio *audio,
  390. u32 mode)
  391. {
  392. static char *name[] = {
  393. [ V4L2_TUNER_MODE_MONO ] = "mono",
  394. [ V4L2_TUNER_MODE_STEREO ] = "stereo",
  395. [ V4L2_TUNER_MODE_LANG1 ] = "lang1",
  396. [ V4L2_TUNER_MODE_LANG2 ] = "lang2",
  397. [ V4L2_TUNER_MODE_LANG1_LANG2 ] = "lang1+lang2",
  398. };
  399. static u32 fm[] = {
  400. [ V4L2_TUNER_MODE_MONO ] = 0x00, /* ch1 */
  401. [ V4L2_TUNER_MODE_STEREO ] = 0x80, /* auto */
  402. [ V4L2_TUNER_MODE_LANG1 ] = 0x00, /* ch1 */
  403. [ V4L2_TUNER_MODE_LANG2 ] = 0x01, /* ch2 */
  404. [ V4L2_TUNER_MODE_LANG1_LANG2 ] = 0x80, /* auto */
  405. };
  406. u32 reg;
  407. switch (audio->mode) {
  408. case TVAUDIO_FM_MONO:
  409. /* nothing to do ... */
  410. break;
  411. case TVAUDIO_FM_K_STEREO:
  412. case TVAUDIO_FM_BG_STEREO:
  413. case TVAUDIO_NICAM_AM:
  414. case TVAUDIO_NICAM_FM:
  415. audio_dbg(1, "setstereo [fm] => %s\n",
  416. name[mode % ARRAY_SIZE(name)]);
  417. reg = fm[ mode % ARRAY_SIZE(fm) ];
  418. saa_writeb(SAA7134_FM_DEMATRIX, reg);
  419. break;
  420. case TVAUDIO_FM_SAT_STEREO:
  421. /* Not implemented */
  422. break;
  423. }
  424. return 0;
  425. }
  426. static int tvaudio_thread(void *data)
  427. {
  428. struct saa7134_dev *dev = data;
  429. int carr_vals[ARRAY_SIZE(mainscan)];
  430. unsigned int i, audio, nscan;
  431. int max1,max2,carrier,rx,mode,lastmode,default_carrier;
  432. set_freezable();
  433. for (;;) {
  434. tvaudio_sleep(dev,-1);
  435. if (kthread_should_stop())
  436. goto done;
  437. restart:
  438. try_to_freeze();
  439. dev->thread.scan1 = dev->thread.scan2;
  440. audio_dbg(1, "tvaudio thread scan start [%d]\n",
  441. dev->thread.scan1);
  442. dev->tvaudio = NULL;
  443. saa_writeb(SAA7134_MONITOR_SELECT, 0xa0);
  444. saa_writeb(SAA7134_FM_DEMATRIX, 0x80);
  445. if (dev->ctl_automute)
  446. dev->automute = 1;
  447. mute_input_7134(dev);
  448. /* give the tuner some time */
  449. if (tvaudio_sleep(dev,SCAN_INITIAL_DELAY))
  450. goto restart;
  451. max1 = 0;
  452. max2 = 0;
  453. nscan = 0;
  454. carrier = 0;
  455. default_carrier = 0;
  456. for (i = 0; i < ARRAY_SIZE(mainscan); i++) {
  457. if (!(dev->tvnorm->id & mainscan[i].std))
  458. continue;
  459. if (!default_carrier)
  460. default_carrier = mainscan[i].carr;
  461. nscan++;
  462. }
  463. if (1 == nscan) {
  464. /* only one candidate -- skip scan ;) */
  465. audio_dbg(1, "only one main carrier candidate - skipping scan\n");
  466. max1 = 12345;
  467. carrier = default_carrier;
  468. } else {
  469. /* scan for the main carrier */
  470. saa_writeb(SAA7134_MONITOR_SELECT,0x00);
  471. tvaudio_setmode(dev,&tvaudio[0],NULL);
  472. for (i = 0; i < ARRAY_SIZE(mainscan); i++) {
  473. carr_vals[i] = tvaudio_checkcarrier(dev, mainscan+i);
  474. if (dev->thread.scan1 != dev->thread.scan2)
  475. goto restart;
  476. }
  477. for (max1 = 0, max2 = 0, i = 0; i < ARRAY_SIZE(mainscan); i++) {
  478. if (max1 < carr_vals[i]) {
  479. max2 = max1;
  480. max1 = carr_vals[i];
  481. carrier = mainscan[i].carr;
  482. } else if (max2 < carr_vals[i]) {
  483. max2 = carr_vals[i];
  484. }
  485. }
  486. }
  487. if (0 != carrier && max1 > 2000 && max1 > max2*3) {
  488. /* found good carrier */
  489. audio_dbg(1, "found %s main sound carrier @ %d.%03d MHz [%d/%d]\n",
  490. dev->tvnorm->name, carrier/1000, carrier%1000,
  491. max1, max2);
  492. dev->last_carrier = carrier;
  493. dev->automute = 0;
  494. } else if (0 != dev->last_carrier) {
  495. /* no carrier -- try last detected one as fallback */
  496. carrier = dev->last_carrier;
  497. audio_dbg(1, "audio carrier scan failed, using %d.%03d MHz [last detected]\n",
  498. carrier/1000, carrier%1000);
  499. dev->automute = 1;
  500. } else {
  501. /* no carrier + no fallback -- use default */
  502. carrier = default_carrier;
  503. audio_dbg(1, "audio carrier scan failed, using %d.%03d MHz [default]\n",
  504. carrier/1000, carrier%1000);
  505. dev->automute = 1;
  506. }
  507. tvaudio_setcarrier(dev,carrier,carrier);
  508. saa_andorb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0x30, 0x00);
  509. saa7134_tvaudio_setmute(dev);
  510. /* find the exact tv audio norm */
  511. for (audio = UNSET, i = 0; i < TVAUDIO; i++) {
  512. if (dev->tvnorm->id != UNSET &&
  513. !(dev->tvnorm->id & tvaudio[i].std))
  514. continue;
  515. if (tvaudio[i].carr1 != carrier)
  516. continue;
  517. /* Note: at least the primary carrier is right here */
  518. if (UNSET == audio)
  519. audio = i;
  520. tvaudio_setmode(dev,&tvaudio[i],"trying");
  521. if (tvaudio_sleep(dev,SCAN_SUBCARRIER_DELAY))
  522. goto restart;
  523. if (-1 != tvaudio_getstereo(dev,&tvaudio[i])) {
  524. audio = i;
  525. break;
  526. }
  527. }
  528. saa_andorb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0x30, 0x30);
  529. if (UNSET == audio)
  530. continue;
  531. tvaudio_setmode(dev,&tvaudio[audio],"using");
  532. tvaudio_setstereo(dev,&tvaudio[audio],V4L2_TUNER_MODE_MONO);
  533. dev->tvaudio = &tvaudio[audio];
  534. lastmode = 42;
  535. for (;;) {
  536. try_to_freeze();
  537. if (tvaudio_sleep(dev,5000))
  538. goto restart;
  539. if (kthread_should_stop())
  540. break;
  541. if (UNSET == dev->thread.mode) {
  542. rx = tvaudio_getstereo(dev, &tvaudio[audio]);
  543. mode = saa7134_tvaudio_rx2mode(rx);
  544. } else {
  545. mode = dev->thread.mode;
  546. }
  547. if (lastmode != mode) {
  548. tvaudio_setstereo(dev,&tvaudio[audio],mode);
  549. lastmode = mode;
  550. }
  551. }
  552. }
  553. done:
  554. dev->thread.stopped = 1;
  555. return 0;
  556. }
  557. /* ------------------------------------------------------------------ */
  558. /* saa7133 / saa7135 code */
  559. static char *stdres[0x20] = {
  560. [0x00] = "no standard detected",
  561. [0x01] = "B/G (in progress)",
  562. [0x02] = "D/K (in progress)",
  563. [0x03] = "M (in progress)",
  564. [0x04] = "B/G A2",
  565. [0x05] = "B/G NICAM",
  566. [0x06] = "D/K A2 (1)",
  567. [0x07] = "D/K A2 (2)",
  568. [0x08] = "D/K A2 (3)",
  569. [0x09] = "D/K NICAM",
  570. [0x0a] = "L NICAM",
  571. [0x0b] = "I NICAM",
  572. [0x0c] = "M Korea",
  573. [0x0d] = "M BTSC ",
  574. [0x0e] = "M EIAJ",
  575. [0x0f] = "FM radio / IF 10.7 / 50 deemp",
  576. [0x10] = "FM radio / IF 10.7 / 75 deemp",
  577. [0x11] = "FM radio / IF sel / 50 deemp",
  578. [0x12] = "FM radio / IF sel / 75 deemp",
  579. [0x13 ... 0x1e ] = "unknown",
  580. [0x1f] = "??? [in progress]",
  581. };
  582. #define DSP_RETRY 32
  583. #define DSP_DELAY 16
  584. #define SAA7135_DSP_RWCLEAR_RERR 1
  585. static inline int saa_dsp_reset_error_bit(struct saa7134_dev *dev)
  586. {
  587. int state = saa_readb(SAA7135_DSP_RWSTATE);
  588. if (unlikely(state & SAA7135_DSP_RWSTATE_ERR)) {
  589. audio_dbg(2, "%s: resetting error bit\n", dev->name);
  590. saa_writeb(SAA7135_DSP_RWCLEAR, SAA7135_DSP_RWCLEAR_RERR);
  591. }
  592. return 0;
  593. }
  594. static inline int saa_dsp_wait_bit(struct saa7134_dev *dev, int bit)
  595. {
  596. int state, count = DSP_RETRY;
  597. state = saa_readb(SAA7135_DSP_RWSTATE);
  598. if (unlikely(state & SAA7135_DSP_RWSTATE_ERR)) {
  599. pr_warn("%s: dsp access error\n", dev->name);
  600. saa_dsp_reset_error_bit(dev);
  601. return -EIO;
  602. }
  603. while (0 == (state & bit)) {
  604. if (unlikely(0 == count)) {
  605. pr_err("dsp access wait timeout [bit=%s]\n",
  606. (bit & SAA7135_DSP_RWSTATE_WRR) ? "WRR" :
  607. (bit & SAA7135_DSP_RWSTATE_RDB) ? "RDB" :
  608. (bit & SAA7135_DSP_RWSTATE_IDA) ? "IDA" :
  609. "???");
  610. return -EIO;
  611. }
  612. saa_wait(DSP_DELAY);
  613. state = saa_readb(SAA7135_DSP_RWSTATE);
  614. count--;
  615. }
  616. return 0;
  617. }
  618. int saa_dsp_writel(struct saa7134_dev *dev, int reg, u32 value)
  619. {
  620. int err;
  621. audio_dbg(2, "dsp write reg 0x%x = 0x%06x\n",
  622. (reg << 2) & 0xffffffff, value);
  623. err = saa_dsp_wait_bit(dev,SAA7135_DSP_RWSTATE_WRR);
  624. if (err < 0)
  625. return err;
  626. saa_writel(reg,value);
  627. err = saa_dsp_wait_bit(dev,SAA7135_DSP_RWSTATE_WRR);
  628. if (err < 0)
  629. return err;
  630. return 0;
  631. }
  632. static int getstereo_7133(struct saa7134_dev *dev)
  633. {
  634. int retval = V4L2_TUNER_SUB_MONO;
  635. u32 value;
  636. value = saa_readl(0x528 >> 2);
  637. if (value & 0x20)
  638. retval = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
  639. if (value & 0x40)
  640. retval = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
  641. return retval;
  642. }
  643. static int mute_input_7133(struct saa7134_dev *dev)
  644. {
  645. u32 reg = 0;
  646. u32 xbarin, xbarout;
  647. int mask;
  648. struct saa7134_input *in;
  649. xbarin = 0x03;
  650. switch (dev->input->amux) {
  651. case TV:
  652. reg = 0x02;
  653. xbarin = 0;
  654. break;
  655. case LINE1:
  656. reg = 0x00;
  657. break;
  658. case LINE2:
  659. case LINE2_LEFT:
  660. reg = 0x09;
  661. break;
  662. }
  663. saa_dsp_writel(dev, 0x464 >> 2, xbarin);
  664. if (dev->ctl_mute) {
  665. reg = 0x07;
  666. xbarout = 0xbbbbbb;
  667. } else
  668. xbarout = 0xbbbb10;
  669. saa_dsp_writel(dev, 0x46c >> 2, xbarout);
  670. saa_writel(0x594 >> 2, reg);
  671. /* switch gpio-connected external audio mux */
  672. if (0 != card(dev).gpiomask) {
  673. mask = card(dev).gpiomask;
  674. if (card(dev).mute.type && dev->ctl_mute)
  675. in = &card(dev).mute;
  676. else
  677. in = dev->input;
  678. saa_andorl(SAA7134_GPIO_GPMODE0 >> 2, mask, mask);
  679. saa_andorl(SAA7134_GPIO_GPSTATUS0 >> 2, mask, in->gpio);
  680. saa7134_track_gpio(dev, saa7134_input_name[in->type]);
  681. }
  682. return 0;
  683. }
  684. static int tvaudio_thread_ddep(void *data)
  685. {
  686. struct saa7134_dev *dev = data;
  687. u32 value, norms;
  688. set_freezable();
  689. for (;;) {
  690. tvaudio_sleep(dev,-1);
  691. if (kthread_should_stop())
  692. goto done;
  693. restart:
  694. try_to_freeze();
  695. dev->thread.scan1 = dev->thread.scan2;
  696. audio_dbg(1, "tvaudio thread scan start [%d]\n",
  697. dev->thread.scan1);
  698. if (audio_ddep >= 0x04 && audio_ddep <= 0x0e) {
  699. /* insmod option override */
  700. norms = (audio_ddep << 2) | 0x01;
  701. audio_dbg(1, "ddep override: %s\n",
  702. stdres[audio_ddep]);
  703. } else if (&card(dev).radio == dev->input) {
  704. audio_dbg(1, "FM Radio\n");
  705. if (dev->tuner_type == TUNER_PHILIPS_TDA8290) {
  706. norms = (0x11 << 2) | 0x01;
  707. /* set IF frequency to 5.5 MHz */
  708. saa_dsp_writel(dev, 0x42c >> 2, 0x729555);
  709. } else {
  710. norms = (0x0f << 2) | 0x01;
  711. }
  712. } else {
  713. /* (let chip) scan for sound carrier */
  714. norms = 0;
  715. if (dev->tvnorm->id & (V4L2_STD_B | V4L2_STD_GH))
  716. norms |= 0x04;
  717. if (dev->tvnorm->id & V4L2_STD_PAL_I)
  718. norms |= 0x20;
  719. if (dev->tvnorm->id & V4L2_STD_DK)
  720. norms |= 0x08;
  721. if (dev->tvnorm->id & V4L2_STD_MN)
  722. norms |= 0x40;
  723. if (dev->tvnorm->id & (V4L2_STD_SECAM_L | V4L2_STD_SECAM_LC))
  724. norms |= 0x10;
  725. if (0 == norms)
  726. norms = 0x7c; /* all */
  727. audio_dbg(1, "scanning:%s%s%s%s%s\n",
  728. (norms & 0x04) ? " B/G" : "",
  729. (norms & 0x08) ? " D/K" : "",
  730. (norms & 0x10) ? " L/L'" : "",
  731. (norms & 0x20) ? " I" : "",
  732. (norms & 0x40) ? " M" : "");
  733. }
  734. /* kick automatic standard detection */
  735. saa_dsp_writel(dev, 0x454 >> 2, 0);
  736. saa_dsp_writel(dev, 0x454 >> 2, norms | 0x80);
  737. /* setup crossbars */
  738. saa_dsp_writel(dev, 0x464 >> 2, 0x000000);
  739. saa_dsp_writel(dev, 0x470 >> 2, 0x101010);
  740. if (tvaudio_sleep(dev,3000))
  741. goto restart;
  742. value = saa_readl(0x528 >> 2) & 0xffffff;
  743. audio_dbg(1, "tvaudio thread status: 0x%x [%s%s%s]\n",
  744. value, stdres[value & 0x1f],
  745. (value & 0x000020) ? ",stereo" : "",
  746. (value & 0x000040) ? ",dual" : "");
  747. audio_dbg(1, "detailed status: %s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s\n",
  748. (value & 0x000080) ? " A2/EIAJ pilot tone " : "",
  749. (value & 0x000100) ? " A2/EIAJ dual " : "",
  750. (value & 0x000200) ? " A2/EIAJ stereo " : "",
  751. (value & 0x000400) ? " A2/EIAJ noise mute " : "",
  752. (value & 0x000800) ? " BTSC/FM radio pilot " : "",
  753. (value & 0x001000) ? " SAP carrier " : "",
  754. (value & 0x002000) ? " BTSC stereo noise mute " : "",
  755. (value & 0x004000) ? " SAP noise mute " : "",
  756. (value & 0x008000) ? " VDSP " : "",
  757. (value & 0x010000) ? " NICST " : "",
  758. (value & 0x020000) ? " NICDU " : "",
  759. (value & 0x040000) ? " NICAM muted " : "",
  760. (value & 0x080000) ? " NICAM reserve sound " : "",
  761. (value & 0x100000) ? " init done " : "");
  762. }
  763. done:
  764. dev->thread.stopped = 1;
  765. return 0;
  766. }
  767. /* ------------------------------------------------------------------ */
  768. /* common stuff + external entry points */
  769. void saa7134_enable_i2s(struct saa7134_dev *dev)
  770. {
  771. int i2s_format;
  772. if (!card_is_empress(dev))
  773. return;
  774. if (dev->pci->device == PCI_DEVICE_ID_PHILIPS_SAA7130)
  775. return;
  776. /* configure GPIO for out */
  777. saa_andorl(SAA7134_GPIO_GPMODE0 >> 2, 0x0E000000, 0x00000000);
  778. switch (dev->pci->device) {
  779. case PCI_DEVICE_ID_PHILIPS_SAA7133:
  780. case PCI_DEVICE_ID_PHILIPS_SAA7135:
  781. /* Set I2S format (SONY)  */
  782. saa_writeb(SAA7133_I2S_AUDIO_CONTROL, 0x00);
  783. /* Start I2S */
  784. saa_writeb(SAA7134_I2S_AUDIO_OUTPUT, 0x11);
  785. break;
  786. case PCI_DEVICE_ID_PHILIPS_SAA7134:
  787. i2s_format = (dev->input->amux == TV) ? 0x00 : 0x01;
  788. /* enable I2S audio output for the mpeg encoder */
  789. saa_writeb(SAA7134_I2S_OUTPUT_SELECT, 0x80);
  790. saa_writeb(SAA7134_I2S_OUTPUT_FORMAT, i2s_format);
  791. saa_writeb(SAA7134_I2S_OUTPUT_LEVEL, 0x0F);
  792. saa_writeb(SAA7134_I2S_AUDIO_OUTPUT, 0x01);
  793. default:
  794. break;
  795. }
  796. }
  797. int saa7134_tvaudio_rx2mode(u32 rx)
  798. {
  799. u32 mode;
  800. mode = V4L2_TUNER_MODE_MONO;
  801. if (rx & V4L2_TUNER_SUB_STEREO)
  802. mode = V4L2_TUNER_MODE_STEREO;
  803. else if (rx & V4L2_TUNER_SUB_LANG1)
  804. mode = V4L2_TUNER_MODE_LANG1;
  805. else if (rx & V4L2_TUNER_SUB_LANG2)
  806. mode = V4L2_TUNER_MODE_LANG2;
  807. return mode;
  808. }
  809. void saa7134_tvaudio_setmute(struct saa7134_dev *dev)
  810. {
  811. switch (dev->pci->device) {
  812. case PCI_DEVICE_ID_PHILIPS_SAA7130:
  813. case PCI_DEVICE_ID_PHILIPS_SAA7134:
  814. mute_input_7134(dev);
  815. break;
  816. case PCI_DEVICE_ID_PHILIPS_SAA7133:
  817. case PCI_DEVICE_ID_PHILIPS_SAA7135:
  818. mute_input_7133(dev);
  819. break;
  820. }
  821. }
  822. void saa7134_tvaudio_setinput(struct saa7134_dev *dev,
  823. struct saa7134_input *in)
  824. {
  825. dev->input = in;
  826. switch (dev->pci->device) {
  827. case PCI_DEVICE_ID_PHILIPS_SAA7130:
  828. case PCI_DEVICE_ID_PHILIPS_SAA7134:
  829. mute_input_7134(dev);
  830. break;
  831. case PCI_DEVICE_ID_PHILIPS_SAA7133:
  832. case PCI_DEVICE_ID_PHILIPS_SAA7135:
  833. mute_input_7133(dev);
  834. break;
  835. }
  836. saa7134_enable_i2s(dev);
  837. }
  838. void saa7134_tvaudio_setvolume(struct saa7134_dev *dev, int level)
  839. {
  840. switch (dev->pci->device) {
  841. case PCI_DEVICE_ID_PHILIPS_SAA7134:
  842. saa_writeb(SAA7134_CHANNEL1_LEVEL, level & 0x1f);
  843. saa_writeb(SAA7134_CHANNEL2_LEVEL, level & 0x1f);
  844. saa_writeb(SAA7134_NICAM_LEVEL_ADJUST, level & 0x1f);
  845. break;
  846. }
  847. }
  848. int saa7134_tvaudio_getstereo(struct saa7134_dev *dev)
  849. {
  850. int retval = V4L2_TUNER_SUB_MONO;
  851. switch (dev->pci->device) {
  852. case PCI_DEVICE_ID_PHILIPS_SAA7134:
  853. if (dev->tvaudio)
  854. retval = tvaudio_getstereo(dev,dev->tvaudio);
  855. break;
  856. case PCI_DEVICE_ID_PHILIPS_SAA7133:
  857. case PCI_DEVICE_ID_PHILIPS_SAA7135:
  858. retval = getstereo_7133(dev);
  859. break;
  860. }
  861. return retval;
  862. }
  863. void saa7134_tvaudio_init(struct saa7134_dev *dev)
  864. {
  865. int clock = saa7134_boards[dev->board].audio_clock;
  866. if (UNSET != audio_clock_override)
  867. clock = audio_clock_override;
  868. switch (dev->pci->device) {
  869. case PCI_DEVICE_ID_PHILIPS_SAA7134:
  870. /* init all audio registers */
  871. saa_writeb(SAA7134_AUDIO_PLL_CTRL, 0x00);
  872. if (need_resched())
  873. schedule();
  874. else
  875. udelay(10);
  876. saa_writeb(SAA7134_AUDIO_CLOCK0, clock & 0xff);
  877. saa_writeb(SAA7134_AUDIO_CLOCK1, (clock >> 8) & 0xff);
  878. saa_writeb(SAA7134_AUDIO_CLOCK2, (clock >> 16) & 0xff);
  879. /* frame locked audio is mandatory for NICAM */
  880. saa_writeb(SAA7134_AUDIO_PLL_CTRL, 0x01);
  881. saa_writeb(SAA7134_NICAM_ERROR_LOW, 0x14);
  882. saa_writeb(SAA7134_NICAM_ERROR_HIGH, 0x50);
  883. break;
  884. case PCI_DEVICE_ID_PHILIPS_SAA7133:
  885. case PCI_DEVICE_ID_PHILIPS_SAA7135:
  886. saa_writel(0x598 >> 2, clock);
  887. saa_dsp_writel(dev, 0x474 >> 2, 0x00);
  888. saa_dsp_writel(dev, 0x450 >> 2, 0x00);
  889. }
  890. }
  891. int saa7134_tvaudio_init2(struct saa7134_dev *dev)
  892. {
  893. int (*my_thread)(void *data) = NULL;
  894. switch (dev->pci->device) {
  895. case PCI_DEVICE_ID_PHILIPS_SAA7134:
  896. my_thread = tvaudio_thread;
  897. break;
  898. case PCI_DEVICE_ID_PHILIPS_SAA7133:
  899. case PCI_DEVICE_ID_PHILIPS_SAA7135:
  900. my_thread = tvaudio_thread_ddep;
  901. break;
  902. }
  903. dev->thread.thread = NULL;
  904. dev->thread.scan1 = dev->thread.scan2 = 0;
  905. if (my_thread) {
  906. saa7134_tvaudio_init(dev);
  907. /* start tvaudio thread */
  908. dev->thread.thread = kthread_run(my_thread, dev, "%s", dev->name);
  909. if (IS_ERR(dev->thread.thread)) {
  910. pr_warn("%s: kernel_thread() failed\n",
  911. dev->name);
  912. /* XXX: missing error handling here */
  913. }
  914. }
  915. saa7134_enable_i2s(dev);
  916. return 0;
  917. }
  918. int saa7134_tvaudio_close(struct saa7134_dev *dev)
  919. {
  920. dev->automute = 1;
  921. /* anything else to undo? */
  922. return 0;
  923. }
  924. int saa7134_tvaudio_fini(struct saa7134_dev *dev)
  925. {
  926. /* shutdown tvaudio thread */
  927. if (dev->thread.thread && !dev->thread.stopped)
  928. kthread_stop(dev->thread.thread);
  929. saa_andorb(SAA7134_ANALOG_IO_SELECT, 0x07, 0x00); /* LINE1 */
  930. return 0;
  931. }
  932. int saa7134_tvaudio_do_scan(struct saa7134_dev *dev)
  933. {
  934. if (dev->input->amux != TV) {
  935. audio_dbg(1, "sound IF not in use, skipping scan\n");
  936. dev->automute = 0;
  937. saa7134_tvaudio_setmute(dev);
  938. } else if (dev->thread.thread) {
  939. dev->thread.mode = UNSET;
  940. dev->thread.scan2++;
  941. if (!dev->insuspend && !dev->thread.stopped)
  942. wake_up_process(dev->thread.thread);
  943. } else {
  944. dev->automute = 0;
  945. saa7134_tvaudio_setmute(dev);
  946. }
  947. return 0;
  948. }
  949. EXPORT_SYMBOL(saa_dsp_writel);
  950. EXPORT_SYMBOL(saa7134_tvaudio_setmute);