radio-si470x-common.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722
  1. /*
  2. * drivers/media/radio/si470x/radio-si470x-common.c
  3. *
  4. * Driver for radios with Silicon Labs Si470x FM Radio Receivers
  5. *
  6. * Copyright (c) 2009 Tobias Lorenz <tobias.lorenz@gmx.net>
  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. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  21. */
  22. /*
  23. * History:
  24. * 2008-01-12 Tobias Lorenz <tobias.lorenz@gmx.net>
  25. * Version 1.0.0
  26. * - First working version
  27. * 2008-01-13 Tobias Lorenz <tobias.lorenz@gmx.net>
  28. * Version 1.0.1
  29. * - Improved error handling, every function now returns errno
  30. * - Improved multi user access (start/mute/stop)
  31. * - Channel doesn't get lost anymore after start/mute/stop
  32. * - RDS support added (polling mode via interrupt EP 1)
  33. * - marked default module parameters with *value*
  34. * - switched from bit structs to bit masks
  35. * - header file cleaned and integrated
  36. * 2008-01-14 Tobias Lorenz <tobias.lorenz@gmx.net>
  37. * Version 1.0.2
  38. * - hex values are now lower case
  39. * - commented USB ID for ADS/Tech moved on todo list
  40. * - blacklisted si470x in hid-quirks.c
  41. * - rds buffer handling functions integrated into *_work, *_read
  42. * - rds_command in si470x_poll exchanged against simple retval
  43. * - check for firmware version 15
  44. * - code order and prototypes still remain the same
  45. * - spacing and bottom of band codes remain the same
  46. * 2008-01-16 Tobias Lorenz <tobias.lorenz@gmx.net>
  47. * Version 1.0.3
  48. * - code reordered to avoid function prototypes
  49. * - switch/case defaults are now more user-friendly
  50. * - unified comment style
  51. * - applied all checkpatch.pl v1.12 suggestions
  52. * except the warning about the too long lines with bit comments
  53. * - renamed FMRADIO to RADIO to cut line length (checkpatch.pl)
  54. * 2008-01-22 Tobias Lorenz <tobias.lorenz@gmx.net>
  55. * Version 1.0.4
  56. * - avoid poss. locking when doing copy_to_user which may sleep
  57. * - RDS is automatically activated on read now
  58. * - code cleaned of unnecessary rds_commands
  59. * - USB Vendor/Product ID for ADS/Tech FM Radio Receiver verified
  60. * (thanks to Guillaume RAMOUSSE)
  61. * 2008-01-27 Tobias Lorenz <tobias.lorenz@gmx.net>
  62. * Version 1.0.5
  63. * - number of seek_retries changed to tune_timeout
  64. * - fixed problem with incomplete tune operations by own buffers
  65. * - optimization of variables and printf types
  66. * - improved error logging
  67. * 2008-01-31 Tobias Lorenz <tobias.lorenz@gmx.net>
  68. * Oliver Neukum <oliver@neukum.org>
  69. * Version 1.0.6
  70. * - fixed coverity checker warnings in *_usb_driver_disconnect
  71. * - probe()/open() race by correct ordering in probe()
  72. * - DMA coherency rules by separate allocation of all buffers
  73. * - use of endianness macros
  74. * - abuse of spinlock, replaced by mutex
  75. * - racy handling of timer in disconnect,
  76. * replaced by delayed_work
  77. * - racy interruptible_sleep_on(),
  78. * replaced with wait_event_interruptible()
  79. * - handle signals in read()
  80. * 2008-02-08 Tobias Lorenz <tobias.lorenz@gmx.net>
  81. * Oliver Neukum <oliver@neukum.org>
  82. * Version 1.0.7
  83. * - usb autosuspend support
  84. * - unplugging fixed
  85. * 2008-05-07 Tobias Lorenz <tobias.lorenz@gmx.net>
  86. * Version 1.0.8
  87. * - hardware frequency seek support
  88. * - afc indication
  89. * - more safety checks, let si470x_get_freq return errno
  90. * - vidioc behavior corrected according to v4l2 spec
  91. * 2008-10-20 Alexey Klimov <klimov.linux@gmail.com>
  92. * - add support for KWorld USB FM Radio FM700
  93. * - blacklisted KWorld radio in hid-core.c and hid-ids.h
  94. * 2008-12-03 Mark Lord <mlord@pobox.com>
  95. * - add support for DealExtreme USB Radio
  96. * 2009-01-31 Bob Ross <pigiron@gmx.com>
  97. * - correction of stereo detection/setting
  98. * - correction of signal strength indicator scaling
  99. * 2009-01-31 Rick Bronson <rick@efn.org>
  100. * Tobias Lorenz <tobias.lorenz@gmx.net>
  101. * - add LED status output
  102. * - get HW/SW version from scratchpad
  103. * 2009-06-16 Edouard Lafargue <edouard@lafargue.name>
  104. * Version 1.0.10
  105. * - add support for interrupt mode for RDS endpoint,
  106. * instead of polling.
  107. * Improves RDS reception significantly
  108. */
  109. /* kernel includes */
  110. #include "radio-si470x.h"
  111. /**************************************************************************
  112. * Module Parameters
  113. **************************************************************************/
  114. /* Spacing (kHz) */
  115. /* 0: 200 kHz (USA, Australia) */
  116. /* 1: 100 kHz (Europe, Japan) */
  117. /* 2: 50 kHz */
  118. static unsigned short space = 2;
  119. module_param(space, ushort, 0444);
  120. MODULE_PARM_DESC(space, "Spacing: 0=200kHz 1=100kHz *2=50kHz*");
  121. /* Bottom of Band (MHz) */
  122. /* 0: 87.5 - 108 MHz (USA, Europe)*/
  123. /* 1: 76 - 108 MHz (Japan wide band) */
  124. /* 2: 76 - 90 MHz (Japan) */
  125. static unsigned short band = 1;
  126. module_param(band, ushort, 0444);
  127. MODULE_PARM_DESC(band, "Band: 0=87.5..108MHz *1=76..108MHz* 2=76..90MHz");
  128. /* De-emphasis */
  129. /* 0: 75 us (USA) */
  130. /* 1: 50 us (Europe, Australia, Japan) */
  131. static unsigned short de = 1;
  132. module_param(de, ushort, 0444);
  133. MODULE_PARM_DESC(de, "De-emphasis: 0=75us *1=50us*");
  134. /* Tune timeout */
  135. static unsigned int tune_timeout = 3000;
  136. module_param(tune_timeout, uint, 0644);
  137. MODULE_PARM_DESC(tune_timeout, "Tune timeout: *3000*");
  138. /* Seek timeout */
  139. static unsigned int seek_timeout = 5000;
  140. module_param(seek_timeout, uint, 0644);
  141. MODULE_PARM_DESC(seek_timeout, "Seek timeout: *5000*");
  142. /**************************************************************************
  143. * Generic Functions
  144. **************************************************************************/
  145. /*
  146. * si470x_set_chan - set the channel
  147. */
  148. static int si470x_set_chan(struct si470x_device *radio, unsigned short chan)
  149. {
  150. int retval;
  151. bool timed_out = 0;
  152. /* start tuning */
  153. radio->registers[CHANNEL] &= ~CHANNEL_CHAN;
  154. radio->registers[CHANNEL] |= CHANNEL_TUNE | chan;
  155. retval = si470x_set_register(radio, CHANNEL);
  156. if (retval < 0)
  157. goto done;
  158. /* wait till tune operation has completed */
  159. INIT_COMPLETION(radio->completion);
  160. retval = wait_for_completion_timeout(&radio->completion,
  161. msecs_to_jiffies(tune_timeout));
  162. if (!retval)
  163. timed_out = true;
  164. if ((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0)
  165. dev_warn(&radio->videodev.dev, "tune does not complete\n");
  166. if (timed_out)
  167. dev_warn(&radio->videodev.dev,
  168. "tune timed out after %u ms\n", tune_timeout);
  169. /* stop tuning */
  170. radio->registers[CHANNEL] &= ~CHANNEL_TUNE;
  171. retval = si470x_set_register(radio, CHANNEL);
  172. done:
  173. return retval;
  174. }
  175. /*
  176. * si470x_get_freq - get the frequency
  177. */
  178. static int si470x_get_freq(struct si470x_device *radio, unsigned int *freq)
  179. {
  180. unsigned int spacing, band_bottom;
  181. unsigned short chan;
  182. int retval;
  183. /* Spacing (kHz) */
  184. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_SPACE) >> 4) {
  185. /* 0: 200 kHz (USA, Australia) */
  186. case 0:
  187. spacing = 0.200 * FREQ_MUL; break;
  188. /* 1: 100 kHz (Europe, Japan) */
  189. case 1:
  190. spacing = 0.100 * FREQ_MUL; break;
  191. /* 2: 50 kHz */
  192. default:
  193. spacing = 0.050 * FREQ_MUL; break;
  194. };
  195. /* Bottom of Band (MHz) */
  196. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
  197. /* 0: 87.5 - 108 MHz (USA, Europe) */
  198. case 0:
  199. band_bottom = 87.5 * FREQ_MUL; break;
  200. /* 1: 76 - 108 MHz (Japan wide band) */
  201. default:
  202. band_bottom = 76 * FREQ_MUL; break;
  203. /* 2: 76 - 90 MHz (Japan) */
  204. case 2:
  205. band_bottom = 76 * FREQ_MUL; break;
  206. };
  207. /* read channel */
  208. retval = si470x_get_register(radio, READCHAN);
  209. chan = radio->registers[READCHAN] & READCHAN_READCHAN;
  210. /* Frequency (MHz) = Spacing (kHz) x Channel + Bottom of Band (MHz) */
  211. *freq = chan * spacing + band_bottom;
  212. return retval;
  213. }
  214. /*
  215. * si470x_set_freq - set the frequency
  216. */
  217. int si470x_set_freq(struct si470x_device *radio, unsigned int freq)
  218. {
  219. unsigned int spacing, band_bottom, band_top;
  220. unsigned short chan;
  221. /* Spacing (kHz) */
  222. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_SPACE) >> 4) {
  223. /* 0: 200 kHz (USA, Australia) */
  224. case 0:
  225. spacing = 0.200 * FREQ_MUL; break;
  226. /* 1: 100 kHz (Europe, Japan) */
  227. case 1:
  228. spacing = 0.100 * FREQ_MUL; break;
  229. /* 2: 50 kHz */
  230. default:
  231. spacing = 0.050 * FREQ_MUL; break;
  232. };
  233. /* Bottom/Top of Band (MHz) */
  234. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
  235. /* 0: 87.5 - 108 MHz (USA, Europe) */
  236. case 0:
  237. band_bottom = 87.5 * FREQ_MUL;
  238. band_top = 108 * FREQ_MUL;
  239. break;
  240. /* 1: 76 - 108 MHz (Japan wide band) */
  241. default:
  242. band_bottom = 76 * FREQ_MUL;
  243. band_top = 108 * FREQ_MUL;
  244. break;
  245. /* 2: 76 - 90 MHz (Japan) */
  246. case 2:
  247. band_bottom = 76 * FREQ_MUL;
  248. band_top = 90 * FREQ_MUL;
  249. break;
  250. };
  251. freq = clamp(freq, band_bottom, band_top);
  252. /* Chan = [ Freq (Mhz) - Bottom of Band (MHz) ] / Spacing (kHz) */
  253. chan = (freq - band_bottom) / spacing;
  254. return si470x_set_chan(radio, chan);
  255. }
  256. /*
  257. * si470x_set_seek - set seek
  258. */
  259. static int si470x_set_seek(struct si470x_device *radio,
  260. unsigned int wrap_around, unsigned int seek_upward)
  261. {
  262. int retval = 0;
  263. bool timed_out = 0;
  264. /* start seeking */
  265. radio->registers[POWERCFG] |= POWERCFG_SEEK;
  266. if (wrap_around == 1)
  267. radio->registers[POWERCFG] &= ~POWERCFG_SKMODE;
  268. else
  269. radio->registers[POWERCFG] |= POWERCFG_SKMODE;
  270. if (seek_upward == 1)
  271. radio->registers[POWERCFG] |= POWERCFG_SEEKUP;
  272. else
  273. radio->registers[POWERCFG] &= ~POWERCFG_SEEKUP;
  274. retval = si470x_set_register(radio, POWERCFG);
  275. if (retval < 0)
  276. return retval;
  277. /* wait till tune operation has completed */
  278. INIT_COMPLETION(radio->completion);
  279. retval = wait_for_completion_timeout(&radio->completion,
  280. msecs_to_jiffies(seek_timeout));
  281. if (!retval)
  282. timed_out = true;
  283. if ((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0)
  284. dev_warn(&radio->videodev.dev, "seek does not complete\n");
  285. if (radio->registers[STATUSRSSI] & STATUSRSSI_SF)
  286. dev_warn(&radio->videodev.dev,
  287. "seek failed / band limit reached\n");
  288. /* stop seeking */
  289. radio->registers[POWERCFG] &= ~POWERCFG_SEEK;
  290. retval = si470x_set_register(radio, POWERCFG);
  291. /* try again, if timed out */
  292. if (retval == 0 && timed_out)
  293. return -ENODATA;
  294. return retval;
  295. }
  296. /*
  297. * si470x_start - switch on radio
  298. */
  299. int si470x_start(struct si470x_device *radio)
  300. {
  301. int retval;
  302. /* powercfg */
  303. radio->registers[POWERCFG] =
  304. POWERCFG_DMUTE | POWERCFG_ENABLE | POWERCFG_RDSM;
  305. retval = si470x_set_register(radio, POWERCFG);
  306. if (retval < 0)
  307. goto done;
  308. /* sysconfig 1 */
  309. radio->registers[SYSCONFIG1] =
  310. (de << 11) & SYSCONFIG1_DE; /* DE*/
  311. retval = si470x_set_register(radio, SYSCONFIG1);
  312. if (retval < 0)
  313. goto done;
  314. /* sysconfig 2 */
  315. radio->registers[SYSCONFIG2] =
  316. (0x1f << 8) | /* SEEKTH */
  317. ((band << 6) & SYSCONFIG2_BAND) | /* BAND */
  318. ((space << 4) & SYSCONFIG2_SPACE) | /* SPACE */
  319. 15; /* VOLUME (max) */
  320. retval = si470x_set_register(radio, SYSCONFIG2);
  321. if (retval < 0)
  322. goto done;
  323. /* reset last channel */
  324. retval = si470x_set_chan(radio,
  325. radio->registers[CHANNEL] & CHANNEL_CHAN);
  326. done:
  327. return retval;
  328. }
  329. /*
  330. * si470x_stop - switch off radio
  331. */
  332. int si470x_stop(struct si470x_device *radio)
  333. {
  334. int retval;
  335. /* sysconfig 1 */
  336. radio->registers[SYSCONFIG1] &= ~SYSCONFIG1_RDS;
  337. retval = si470x_set_register(radio, SYSCONFIG1);
  338. if (retval < 0)
  339. goto done;
  340. /* powercfg */
  341. radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
  342. /* POWERCFG_ENABLE has to automatically go low */
  343. radio->registers[POWERCFG] |= POWERCFG_ENABLE | POWERCFG_DISABLE;
  344. retval = si470x_set_register(radio, POWERCFG);
  345. done:
  346. return retval;
  347. }
  348. /*
  349. * si470x_rds_on - switch on rds reception
  350. */
  351. static int si470x_rds_on(struct si470x_device *radio)
  352. {
  353. int retval;
  354. /* sysconfig 1 */
  355. radio->registers[SYSCONFIG1] |= SYSCONFIG1_RDS;
  356. retval = si470x_set_register(radio, SYSCONFIG1);
  357. if (retval < 0)
  358. radio->registers[SYSCONFIG1] &= ~SYSCONFIG1_RDS;
  359. return retval;
  360. }
  361. /**************************************************************************
  362. * File Operations Interface
  363. **************************************************************************/
  364. /*
  365. * si470x_fops_read - read RDS data
  366. */
  367. static ssize_t si470x_fops_read(struct file *file, char __user *buf,
  368. size_t count, loff_t *ppos)
  369. {
  370. struct si470x_device *radio = video_drvdata(file);
  371. int retval = 0;
  372. unsigned int block_count = 0;
  373. /* switch on rds reception */
  374. if ((radio->registers[SYSCONFIG1] & SYSCONFIG1_RDS) == 0)
  375. si470x_rds_on(radio);
  376. /* block if no new data available */
  377. while (radio->wr_index == radio->rd_index) {
  378. if (file->f_flags & O_NONBLOCK) {
  379. retval = -EWOULDBLOCK;
  380. goto done;
  381. }
  382. if (wait_event_interruptible(radio->read_queue,
  383. radio->wr_index != radio->rd_index) < 0) {
  384. retval = -EINTR;
  385. goto done;
  386. }
  387. }
  388. /* calculate block count from byte count */
  389. count /= 3;
  390. /* copy RDS block out of internal buffer and to user buffer */
  391. while (block_count < count) {
  392. if (radio->rd_index == radio->wr_index)
  393. break;
  394. /* always transfer rds complete blocks */
  395. if (copy_to_user(buf, &radio->buffer[radio->rd_index], 3))
  396. /* retval = -EFAULT; */
  397. break;
  398. /* increment and wrap read pointer */
  399. radio->rd_index += 3;
  400. if (radio->rd_index >= radio->buf_size)
  401. radio->rd_index = 0;
  402. /* increment counters */
  403. block_count++;
  404. buf += 3;
  405. retval += 3;
  406. }
  407. done:
  408. return retval;
  409. }
  410. /*
  411. * si470x_fops_poll - poll RDS data
  412. */
  413. static unsigned int si470x_fops_poll(struct file *file,
  414. struct poll_table_struct *pts)
  415. {
  416. struct si470x_device *radio = video_drvdata(file);
  417. unsigned long req_events = poll_requested_events(pts);
  418. int retval = v4l2_ctrl_poll(file, pts);
  419. if (req_events & (POLLIN | POLLRDNORM)) {
  420. /* switch on rds reception */
  421. if ((radio->registers[SYSCONFIG1] & SYSCONFIG1_RDS) == 0)
  422. si470x_rds_on(radio);
  423. poll_wait(file, &radio->read_queue, pts);
  424. if (radio->rd_index != radio->wr_index)
  425. retval |= POLLIN | POLLRDNORM;
  426. }
  427. return retval;
  428. }
  429. /*
  430. * si470x_fops - file operations interface
  431. */
  432. static const struct v4l2_file_operations si470x_fops = {
  433. .owner = THIS_MODULE,
  434. .read = si470x_fops_read,
  435. .poll = si470x_fops_poll,
  436. .unlocked_ioctl = video_ioctl2,
  437. .open = si470x_fops_open,
  438. .release = si470x_fops_release,
  439. };
  440. /**************************************************************************
  441. * Video4Linux Interface
  442. **************************************************************************/
  443. static int si470x_s_ctrl(struct v4l2_ctrl *ctrl)
  444. {
  445. struct si470x_device *radio =
  446. container_of(ctrl->handler, struct si470x_device, hdl);
  447. switch (ctrl->id) {
  448. case V4L2_CID_AUDIO_VOLUME:
  449. radio->registers[SYSCONFIG2] &= ~SYSCONFIG2_VOLUME;
  450. radio->registers[SYSCONFIG2] |= ctrl->val;
  451. return si470x_set_register(radio, SYSCONFIG2);
  452. case V4L2_CID_AUDIO_MUTE:
  453. if (ctrl->val)
  454. radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
  455. else
  456. radio->registers[POWERCFG] |= POWERCFG_DMUTE;
  457. return si470x_set_register(radio, POWERCFG);
  458. default:
  459. return -EINVAL;
  460. }
  461. }
  462. /*
  463. * si470x_vidioc_g_tuner - get tuner attributes
  464. */
  465. static int si470x_vidioc_g_tuner(struct file *file, void *priv,
  466. struct v4l2_tuner *tuner)
  467. {
  468. struct si470x_device *radio = video_drvdata(file);
  469. int retval = 0;
  470. if (tuner->index != 0)
  471. return -EINVAL;
  472. if (!radio->status_rssi_auto_update) {
  473. retval = si470x_get_register(radio, STATUSRSSI);
  474. if (retval < 0)
  475. return retval;
  476. }
  477. /* driver constants */
  478. strcpy(tuner->name, "FM");
  479. tuner->type = V4L2_TUNER_RADIO;
  480. tuner->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
  481. V4L2_TUNER_CAP_RDS | V4L2_TUNER_CAP_RDS_BLOCK_IO |
  482. V4L2_TUNER_CAP_HWSEEK_BOUNDED |
  483. V4L2_TUNER_CAP_HWSEEK_WRAP;
  484. /* range limits */
  485. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
  486. /* 0: 87.5 - 108 MHz (USA, Europe, default) */
  487. default:
  488. tuner->rangelow = 87.5 * FREQ_MUL;
  489. tuner->rangehigh = 108 * FREQ_MUL;
  490. break;
  491. /* 1: 76 - 108 MHz (Japan wide band) */
  492. case 1:
  493. tuner->rangelow = 76 * FREQ_MUL;
  494. tuner->rangehigh = 108 * FREQ_MUL;
  495. break;
  496. /* 2: 76 - 90 MHz (Japan) */
  497. case 2:
  498. tuner->rangelow = 76 * FREQ_MUL;
  499. tuner->rangehigh = 90 * FREQ_MUL;
  500. break;
  501. };
  502. /* stereo indicator == stereo (instead of mono) */
  503. if ((radio->registers[STATUSRSSI] & STATUSRSSI_ST) == 0)
  504. tuner->rxsubchans = V4L2_TUNER_SUB_MONO;
  505. else
  506. tuner->rxsubchans = V4L2_TUNER_SUB_STEREO;
  507. /* If there is a reliable method of detecting an RDS channel,
  508. then this code should check for that before setting this
  509. RDS subchannel. */
  510. tuner->rxsubchans |= V4L2_TUNER_SUB_RDS;
  511. /* mono/stereo selector */
  512. if ((radio->registers[POWERCFG] & POWERCFG_MONO) == 0)
  513. tuner->audmode = V4L2_TUNER_MODE_STEREO;
  514. else
  515. tuner->audmode = V4L2_TUNER_MODE_MONO;
  516. /* min is worst, max is best; signal:0..0xffff; rssi: 0..0xff */
  517. /* measured in units of dbµV in 1 db increments (max at ~75 dbµV) */
  518. tuner->signal = (radio->registers[STATUSRSSI] & STATUSRSSI_RSSI);
  519. /* the ideal factor is 0xffff/75 = 873,8 */
  520. tuner->signal = (tuner->signal * 873) + (8 * tuner->signal / 10);
  521. if (tuner->signal > 0xffff)
  522. tuner->signal = 0xffff;
  523. /* automatic frequency control: -1: freq to low, 1 freq to high */
  524. /* AFCRL does only indicate that freq. differs, not if too low/high */
  525. tuner->afc = (radio->registers[STATUSRSSI] & STATUSRSSI_AFCRL) ? 1 : 0;
  526. return retval;
  527. }
  528. /*
  529. * si470x_vidioc_s_tuner - set tuner attributes
  530. */
  531. static int si470x_vidioc_s_tuner(struct file *file, void *priv,
  532. struct v4l2_tuner *tuner)
  533. {
  534. struct si470x_device *radio = video_drvdata(file);
  535. if (tuner->index != 0)
  536. return -EINVAL;
  537. /* mono/stereo selector */
  538. switch (tuner->audmode) {
  539. case V4L2_TUNER_MODE_MONO:
  540. radio->registers[POWERCFG] |= POWERCFG_MONO; /* force mono */
  541. break;
  542. case V4L2_TUNER_MODE_STEREO:
  543. default:
  544. radio->registers[POWERCFG] &= ~POWERCFG_MONO; /* try stereo */
  545. break;
  546. }
  547. return si470x_set_register(radio, POWERCFG);
  548. }
  549. /*
  550. * si470x_vidioc_g_frequency - get tuner or modulator radio frequency
  551. */
  552. static int si470x_vidioc_g_frequency(struct file *file, void *priv,
  553. struct v4l2_frequency *freq)
  554. {
  555. struct si470x_device *radio = video_drvdata(file);
  556. if (freq->tuner != 0)
  557. return -EINVAL;
  558. freq->type = V4L2_TUNER_RADIO;
  559. return si470x_get_freq(radio, &freq->frequency);
  560. }
  561. /*
  562. * si470x_vidioc_s_frequency - set tuner or modulator radio frequency
  563. */
  564. static int si470x_vidioc_s_frequency(struct file *file, void *priv,
  565. struct v4l2_frequency *freq)
  566. {
  567. struct si470x_device *radio = video_drvdata(file);
  568. if (freq->tuner != 0)
  569. return -EINVAL;
  570. return si470x_set_freq(radio, freq->frequency);
  571. }
  572. /*
  573. * si470x_vidioc_s_hw_freq_seek - set hardware frequency seek
  574. */
  575. static int si470x_vidioc_s_hw_freq_seek(struct file *file, void *priv,
  576. struct v4l2_hw_freq_seek *seek)
  577. {
  578. struct si470x_device *radio = video_drvdata(file);
  579. if (seek->tuner != 0)
  580. return -EINVAL;
  581. return si470x_set_seek(radio, seek->wrap_around, seek->seek_upward);
  582. }
  583. const struct v4l2_ctrl_ops si470x_ctrl_ops = {
  584. .s_ctrl = si470x_s_ctrl,
  585. };
  586. /*
  587. * si470x_ioctl_ops - video device ioctl operations
  588. */
  589. static const struct v4l2_ioctl_ops si470x_ioctl_ops = {
  590. .vidioc_querycap = si470x_vidioc_querycap,
  591. .vidioc_g_tuner = si470x_vidioc_g_tuner,
  592. .vidioc_s_tuner = si470x_vidioc_s_tuner,
  593. .vidioc_g_frequency = si470x_vidioc_g_frequency,
  594. .vidioc_s_frequency = si470x_vidioc_s_frequency,
  595. .vidioc_s_hw_freq_seek = si470x_vidioc_s_hw_freq_seek,
  596. .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
  597. .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
  598. };
  599. /*
  600. * si470x_viddev_template - video device interface
  601. */
  602. struct video_device si470x_viddev_template = {
  603. .fops = &si470x_fops,
  604. .name = DRIVER_NAME,
  605. .release = video_device_release_empty,
  606. .ioctl_ops = &si470x_ioctl_ops,
  607. };