radio-si470x-common.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913
  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. unsigned long timeout;
  152. bool timed_out = 0;
  153. /* start tuning */
  154. radio->registers[CHANNEL] &= ~CHANNEL_CHAN;
  155. radio->registers[CHANNEL] |= CHANNEL_TUNE | chan;
  156. retval = si470x_set_register(radio, CHANNEL);
  157. if (retval < 0)
  158. goto done;
  159. /* wait till tune operation has completed */
  160. timeout = jiffies + msecs_to_jiffies(tune_timeout);
  161. do {
  162. retval = si470x_get_register(radio, STATUSRSSI);
  163. if (retval < 0)
  164. goto stop;
  165. timed_out = time_after(jiffies, timeout);
  166. } while (((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0) &&
  167. (!timed_out));
  168. if ((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0)
  169. dev_warn(&radio->videodev->dev, "tune does not complete\n");
  170. if (timed_out)
  171. dev_warn(&radio->videodev->dev,
  172. "tune timed out after %u ms\n", tune_timeout);
  173. stop:
  174. /* stop tuning */
  175. radio->registers[CHANNEL] &= ~CHANNEL_TUNE;
  176. retval = si470x_set_register(radio, CHANNEL);
  177. done:
  178. return retval;
  179. }
  180. /*
  181. * si470x_get_freq - get the frequency
  182. */
  183. static int si470x_get_freq(struct si470x_device *radio, unsigned int *freq)
  184. {
  185. unsigned int spacing, band_bottom;
  186. unsigned short chan;
  187. int retval;
  188. /* Spacing (kHz) */
  189. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_SPACE) >> 4) {
  190. /* 0: 200 kHz (USA, Australia) */
  191. case 0:
  192. spacing = 0.200 * FREQ_MUL; break;
  193. /* 1: 100 kHz (Europe, Japan) */
  194. case 1:
  195. spacing = 0.100 * FREQ_MUL; break;
  196. /* 2: 50 kHz */
  197. default:
  198. spacing = 0.050 * FREQ_MUL; break;
  199. };
  200. /* Bottom of Band (MHz) */
  201. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
  202. /* 0: 87.5 - 108 MHz (USA, Europe) */
  203. case 0:
  204. band_bottom = 87.5 * FREQ_MUL; break;
  205. /* 1: 76 - 108 MHz (Japan wide band) */
  206. default:
  207. band_bottom = 76 * FREQ_MUL; break;
  208. /* 2: 76 - 90 MHz (Japan) */
  209. case 2:
  210. band_bottom = 76 * FREQ_MUL; break;
  211. };
  212. /* read channel */
  213. retval = si470x_get_register(radio, READCHAN);
  214. chan = radio->registers[READCHAN] & READCHAN_READCHAN;
  215. /* Frequency (MHz) = Spacing (kHz) x Channel + Bottom of Band (MHz) */
  216. *freq = chan * spacing + band_bottom;
  217. return retval;
  218. }
  219. /*
  220. * si470x_set_freq - set the frequency
  221. */
  222. int si470x_set_freq(struct si470x_device *radio, unsigned int freq)
  223. {
  224. unsigned int spacing, band_bottom;
  225. unsigned short chan;
  226. /* Spacing (kHz) */
  227. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_SPACE) >> 4) {
  228. /* 0: 200 kHz (USA, Australia) */
  229. case 0:
  230. spacing = 0.200 * FREQ_MUL; break;
  231. /* 1: 100 kHz (Europe, Japan) */
  232. case 1:
  233. spacing = 0.100 * FREQ_MUL; break;
  234. /* 2: 50 kHz */
  235. default:
  236. spacing = 0.050 * FREQ_MUL; break;
  237. };
  238. /* Bottom of Band (MHz) */
  239. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
  240. /* 0: 87.5 - 108 MHz (USA, Europe) */
  241. case 0:
  242. band_bottom = 87.5 * FREQ_MUL; break;
  243. /* 1: 76 - 108 MHz (Japan wide band) */
  244. default:
  245. band_bottom = 76 * FREQ_MUL; break;
  246. /* 2: 76 - 90 MHz (Japan) */
  247. case 2:
  248. band_bottom = 76 * FREQ_MUL; break;
  249. };
  250. /* Chan = [ Freq (Mhz) - Bottom of Band (MHz) ] / Spacing (kHz) */
  251. chan = (freq - band_bottom) / spacing;
  252. return si470x_set_chan(radio, chan);
  253. }
  254. /*
  255. * si470x_set_seek - set seek
  256. */
  257. static int si470x_set_seek(struct si470x_device *radio,
  258. unsigned int wrap_around, unsigned int seek_upward)
  259. {
  260. int retval = 0;
  261. unsigned long timeout;
  262. bool timed_out = 0;
  263. /* start seeking */
  264. radio->registers[POWERCFG] |= POWERCFG_SEEK;
  265. if (wrap_around == 1)
  266. radio->registers[POWERCFG] &= ~POWERCFG_SKMODE;
  267. else
  268. radio->registers[POWERCFG] |= POWERCFG_SKMODE;
  269. if (seek_upward == 1)
  270. radio->registers[POWERCFG] |= POWERCFG_SEEKUP;
  271. else
  272. radio->registers[POWERCFG] &= ~POWERCFG_SEEKUP;
  273. retval = si470x_set_register(radio, POWERCFG);
  274. if (retval < 0)
  275. goto done;
  276. /* wait till seek operation has completed */
  277. timeout = jiffies + msecs_to_jiffies(seek_timeout);
  278. do {
  279. retval = si470x_get_register(radio, STATUSRSSI);
  280. if (retval < 0)
  281. goto stop;
  282. timed_out = time_after(jiffies, timeout);
  283. } while (((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0) &&
  284. (!timed_out));
  285. if ((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0)
  286. dev_warn(&radio->videodev->dev, "seek does not complete\n");
  287. if (radio->registers[STATUSRSSI] & STATUSRSSI_SF)
  288. dev_warn(&radio->videodev->dev,
  289. "seek failed / band limit reached\n");
  290. if (timed_out)
  291. dev_warn(&radio->videodev->dev,
  292. "seek timed out after %u ms\n", seek_timeout);
  293. stop:
  294. /* stop seeking */
  295. radio->registers[POWERCFG] &= ~POWERCFG_SEEK;
  296. retval = si470x_set_register(radio, POWERCFG);
  297. done:
  298. /* try again, if timed out */
  299. if ((retval == 0) && timed_out)
  300. retval = -EAGAIN;
  301. return retval;
  302. }
  303. /*
  304. * si470x_start - switch on radio
  305. */
  306. int si470x_start(struct si470x_device *radio)
  307. {
  308. int retval;
  309. /* powercfg */
  310. radio->registers[POWERCFG] =
  311. POWERCFG_DMUTE | POWERCFG_ENABLE | POWERCFG_RDSM;
  312. retval = si470x_set_register(radio, POWERCFG);
  313. if (retval < 0)
  314. goto done;
  315. /* sysconfig 1 */
  316. radio->registers[SYSCONFIG1] = SYSCONFIG1_DE;
  317. retval = si470x_set_register(radio, SYSCONFIG1);
  318. if (retval < 0)
  319. goto done;
  320. /* sysconfig 2 */
  321. radio->registers[SYSCONFIG2] =
  322. (0x3f << 8) | /* SEEKTH */
  323. ((band << 6) & SYSCONFIG2_BAND) | /* BAND */
  324. ((space << 4) & SYSCONFIG2_SPACE) | /* SPACE */
  325. 15; /* VOLUME (max) */
  326. retval = si470x_set_register(radio, SYSCONFIG2);
  327. if (retval < 0)
  328. goto done;
  329. /* reset last channel */
  330. retval = si470x_set_chan(radio,
  331. radio->registers[CHANNEL] & CHANNEL_CHAN);
  332. done:
  333. return retval;
  334. }
  335. /*
  336. * si470x_stop - switch off radio
  337. */
  338. int si470x_stop(struct si470x_device *radio)
  339. {
  340. int retval;
  341. /* sysconfig 1 */
  342. radio->registers[SYSCONFIG1] &= ~SYSCONFIG1_RDS;
  343. retval = si470x_set_register(radio, SYSCONFIG1);
  344. if (retval < 0)
  345. goto done;
  346. /* powercfg */
  347. radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
  348. /* POWERCFG_ENABLE has to automatically go low */
  349. radio->registers[POWERCFG] |= POWERCFG_ENABLE | POWERCFG_DISABLE;
  350. retval = si470x_set_register(radio, POWERCFG);
  351. done:
  352. return retval;
  353. }
  354. /*
  355. * si470x_rds_on - switch on rds reception
  356. */
  357. static int si470x_rds_on(struct si470x_device *radio)
  358. {
  359. int retval;
  360. /* sysconfig 1 */
  361. radio->registers[SYSCONFIG1] |= SYSCONFIG1_RDS;
  362. retval = si470x_set_register(radio, SYSCONFIG1);
  363. if (retval < 0)
  364. radio->registers[SYSCONFIG1] &= ~SYSCONFIG1_RDS;
  365. return retval;
  366. }
  367. /**************************************************************************
  368. * File Operations Interface
  369. **************************************************************************/
  370. /*
  371. * si470x_fops_read - read RDS data
  372. */
  373. static ssize_t si470x_fops_read(struct file *file, char __user *buf,
  374. size_t count, loff_t *ppos)
  375. {
  376. struct si470x_device *radio = video_drvdata(file);
  377. int retval = 0;
  378. unsigned int block_count = 0;
  379. /* switch on rds reception */
  380. mutex_lock(&radio->lock);
  381. if ((radio->registers[SYSCONFIG1] & SYSCONFIG1_RDS) == 0)
  382. si470x_rds_on(radio);
  383. /* block if no new data available */
  384. while (radio->wr_index == radio->rd_index) {
  385. if (file->f_flags & O_NONBLOCK) {
  386. retval = -EWOULDBLOCK;
  387. goto done;
  388. }
  389. if (wait_event_interruptible(radio->read_queue,
  390. radio->wr_index != radio->rd_index) < 0) {
  391. retval = -EINTR;
  392. goto done;
  393. }
  394. }
  395. /* calculate block count from byte count */
  396. count /= 3;
  397. /* copy RDS block out of internal buffer and to user buffer */
  398. mutex_lock(&radio->lock);
  399. while (block_count < count) {
  400. if (radio->rd_index == radio->wr_index)
  401. break;
  402. /* always transfer rds complete blocks */
  403. if (copy_to_user(buf, &radio->buffer[radio->rd_index], 3))
  404. /* retval = -EFAULT; */
  405. break;
  406. /* increment and wrap read pointer */
  407. radio->rd_index += 3;
  408. if (radio->rd_index >= radio->buf_size)
  409. radio->rd_index = 0;
  410. /* increment counters */
  411. block_count++;
  412. buf += 3;
  413. retval += 3;
  414. }
  415. done:
  416. mutex_unlock(&radio->lock);
  417. return retval;
  418. }
  419. /*
  420. * si470x_fops_poll - poll RDS data
  421. */
  422. static unsigned int si470x_fops_poll(struct file *file,
  423. struct poll_table_struct *pts)
  424. {
  425. struct si470x_device *radio = video_drvdata(file);
  426. int retval = 0;
  427. /* switch on rds reception */
  428. mutex_lock(&radio->lock);
  429. if ((radio->registers[SYSCONFIG1] & SYSCONFIG1_RDS) == 0)
  430. si470x_rds_on(radio);
  431. mutex_unlock(&radio->lock);
  432. poll_wait(file, &radio->read_queue, pts);
  433. if (radio->rd_index != radio->wr_index)
  434. retval = POLLIN | POLLRDNORM;
  435. return retval;
  436. }
  437. /*
  438. * si470x_fops - file operations interface
  439. */
  440. static const struct v4l2_file_operations si470x_fops = {
  441. .owner = THIS_MODULE,
  442. .read = si470x_fops_read,
  443. .poll = si470x_fops_poll,
  444. .unlocked_ioctl = video_ioctl2,
  445. .open = si470x_fops_open,
  446. .release = si470x_fops_release,
  447. };
  448. /**************************************************************************
  449. * Video4Linux Interface
  450. **************************************************************************/
  451. /*
  452. * si470x_vidioc_queryctrl - enumerate control items
  453. */
  454. static int si470x_vidioc_queryctrl(struct file *file, void *priv,
  455. struct v4l2_queryctrl *qc)
  456. {
  457. struct si470x_device *radio = video_drvdata(file);
  458. int retval = -EINVAL;
  459. /* abort if qc->id is below V4L2_CID_BASE */
  460. if (qc->id < V4L2_CID_BASE)
  461. goto done;
  462. /* search video control */
  463. switch (qc->id) {
  464. case V4L2_CID_AUDIO_VOLUME:
  465. return v4l2_ctrl_query_fill(qc, 0, 15, 1, 15);
  466. case V4L2_CID_AUDIO_MUTE:
  467. return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);
  468. }
  469. /* disable unsupported base controls */
  470. /* to satisfy kradio and such apps */
  471. if ((retval == -EINVAL) && (qc->id < V4L2_CID_LASTP1)) {
  472. qc->flags = V4L2_CTRL_FLAG_DISABLED;
  473. retval = 0;
  474. }
  475. done:
  476. if (retval < 0)
  477. dev_warn(&radio->videodev->dev,
  478. "query controls failed with %d\n", retval);
  479. return retval;
  480. }
  481. /*
  482. * si470x_vidioc_g_ctrl - get the value of a control
  483. */
  484. static int si470x_vidioc_g_ctrl(struct file *file, void *priv,
  485. struct v4l2_control *ctrl)
  486. {
  487. struct si470x_device *radio = video_drvdata(file);
  488. int retval = 0;
  489. mutex_lock(&radio->lock);
  490. /* safety checks */
  491. retval = si470x_disconnect_check(radio);
  492. if (retval)
  493. goto done;
  494. switch (ctrl->id) {
  495. case V4L2_CID_AUDIO_VOLUME:
  496. ctrl->value = radio->registers[SYSCONFIG2] &
  497. SYSCONFIG2_VOLUME;
  498. break;
  499. case V4L2_CID_AUDIO_MUTE:
  500. ctrl->value = ((radio->registers[POWERCFG] &
  501. POWERCFG_DMUTE) == 0) ? 1 : 0;
  502. break;
  503. default:
  504. retval = -EINVAL;
  505. }
  506. done:
  507. if (retval < 0)
  508. dev_warn(&radio->videodev->dev,
  509. "get control failed with %d\n", retval);
  510. mutex_unlock(&radio->lock);
  511. return retval;
  512. }
  513. /*
  514. * si470x_vidioc_s_ctrl - set the value of a control
  515. */
  516. static int si470x_vidioc_s_ctrl(struct file *file, void *priv,
  517. struct v4l2_control *ctrl)
  518. {
  519. struct si470x_device *radio = video_drvdata(file);
  520. int retval = 0;
  521. mutex_lock(&radio->lock);
  522. /* safety checks */
  523. retval = si470x_disconnect_check(radio);
  524. if (retval)
  525. goto done;
  526. switch (ctrl->id) {
  527. case V4L2_CID_AUDIO_VOLUME:
  528. radio->registers[SYSCONFIG2] &= ~SYSCONFIG2_VOLUME;
  529. radio->registers[SYSCONFIG2] |= ctrl->value;
  530. retval = si470x_set_register(radio, SYSCONFIG2);
  531. break;
  532. case V4L2_CID_AUDIO_MUTE:
  533. if (ctrl->value == 1)
  534. radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
  535. else
  536. radio->registers[POWERCFG] |= POWERCFG_DMUTE;
  537. retval = si470x_set_register(radio, POWERCFG);
  538. break;
  539. default:
  540. retval = -EINVAL;
  541. }
  542. done:
  543. if (retval < 0)
  544. dev_warn(&radio->videodev->dev,
  545. "set control failed with %d\n", retval);
  546. mutex_unlock(&radio->lock);
  547. return retval;
  548. }
  549. /*
  550. * si470x_vidioc_g_audio - get audio attributes
  551. */
  552. static int si470x_vidioc_g_audio(struct file *file, void *priv,
  553. struct v4l2_audio *audio)
  554. {
  555. /* driver constants */
  556. audio->index = 0;
  557. strcpy(audio->name, "Radio");
  558. audio->capability = V4L2_AUDCAP_STEREO;
  559. audio->mode = 0;
  560. return 0;
  561. }
  562. /*
  563. * si470x_vidioc_g_tuner - get tuner attributes
  564. */
  565. static int si470x_vidioc_g_tuner(struct file *file, void *priv,
  566. struct v4l2_tuner *tuner)
  567. {
  568. struct si470x_device *radio = video_drvdata(file);
  569. int retval = 0;
  570. mutex_lock(&radio->lock);
  571. /* safety checks */
  572. retval = si470x_disconnect_check(radio);
  573. if (retval)
  574. goto done;
  575. if (tuner->index != 0) {
  576. retval = -EINVAL;
  577. goto done;
  578. }
  579. retval = si470x_get_register(radio, STATUSRSSI);
  580. if (retval < 0)
  581. goto done;
  582. /* driver constants */
  583. strcpy(tuner->name, "FM");
  584. tuner->type = V4L2_TUNER_RADIO;
  585. #if defined(CONFIG_USB_SI470X) || defined(CONFIG_USB_SI470X_MODULE)
  586. tuner->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
  587. V4L2_TUNER_CAP_RDS;
  588. #else
  589. tuner->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO;
  590. #endif
  591. /* range limits */
  592. switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
  593. /* 0: 87.5 - 108 MHz (USA, Europe, default) */
  594. default:
  595. tuner->rangelow = 87.5 * FREQ_MUL;
  596. tuner->rangehigh = 108 * FREQ_MUL;
  597. break;
  598. /* 1: 76 - 108 MHz (Japan wide band) */
  599. case 1:
  600. tuner->rangelow = 76 * FREQ_MUL;
  601. tuner->rangehigh = 108 * FREQ_MUL;
  602. break;
  603. /* 2: 76 - 90 MHz (Japan) */
  604. case 2:
  605. tuner->rangelow = 76 * FREQ_MUL;
  606. tuner->rangehigh = 90 * FREQ_MUL;
  607. break;
  608. };
  609. /* stereo indicator == stereo (instead of mono) */
  610. if ((radio->registers[STATUSRSSI] & STATUSRSSI_ST) == 0)
  611. tuner->rxsubchans = V4L2_TUNER_SUB_MONO;
  612. else
  613. tuner->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
  614. #if defined(CONFIG_USB_SI470X) || defined(CONFIG_USB_SI470X_MODULE)
  615. /* If there is a reliable method of detecting an RDS channel,
  616. then this code should check for that before setting this
  617. RDS subchannel. */
  618. tuner->rxsubchans |= V4L2_TUNER_SUB_RDS;
  619. #endif
  620. /* mono/stereo selector */
  621. if ((radio->registers[POWERCFG] & POWERCFG_MONO) == 0)
  622. tuner->audmode = V4L2_TUNER_MODE_STEREO;
  623. else
  624. tuner->audmode = V4L2_TUNER_MODE_MONO;
  625. /* min is worst, max is best; signal:0..0xffff; rssi: 0..0xff */
  626. /* measured in units of dbµV in 1 db increments (max at ~75 dbµV) */
  627. tuner->signal = (radio->registers[STATUSRSSI] & STATUSRSSI_RSSI);
  628. /* the ideal factor is 0xffff/75 = 873,8 */
  629. tuner->signal = (tuner->signal * 873) + (8 * tuner->signal / 10);
  630. /* automatic frequency control: -1: freq to low, 1 freq to high */
  631. /* AFCRL does only indicate that freq. differs, not if too low/high */
  632. tuner->afc = (radio->registers[STATUSRSSI] & STATUSRSSI_AFCRL) ? 1 : 0;
  633. done:
  634. if (retval < 0)
  635. dev_warn(&radio->videodev->dev,
  636. "get tuner failed with %d\n", retval);
  637. mutex_unlock(&radio->lock);
  638. return retval;
  639. }
  640. /*
  641. * si470x_vidioc_s_tuner - set tuner attributes
  642. */
  643. static int si470x_vidioc_s_tuner(struct file *file, void *priv,
  644. struct v4l2_tuner *tuner)
  645. {
  646. struct si470x_device *radio = video_drvdata(file);
  647. int retval = 0;
  648. mutex_lock(&radio->lock);
  649. /* safety checks */
  650. retval = si470x_disconnect_check(radio);
  651. if (retval)
  652. goto done;
  653. if (tuner->index != 0)
  654. goto done;
  655. /* mono/stereo selector */
  656. switch (tuner->audmode) {
  657. case V4L2_TUNER_MODE_MONO:
  658. radio->registers[POWERCFG] |= POWERCFG_MONO; /* force mono */
  659. break;
  660. case V4L2_TUNER_MODE_STEREO:
  661. radio->registers[POWERCFG] &= ~POWERCFG_MONO; /* try stereo */
  662. break;
  663. default:
  664. goto done;
  665. }
  666. retval = si470x_set_register(radio, POWERCFG);
  667. done:
  668. if (retval < 0)
  669. dev_warn(&radio->videodev->dev,
  670. "set tuner failed with %d\n", retval);
  671. mutex_unlock(&radio->lock);
  672. return retval;
  673. }
  674. /*
  675. * si470x_vidioc_g_frequency - get tuner or modulator radio frequency
  676. */
  677. static int si470x_vidioc_g_frequency(struct file *file, void *priv,
  678. struct v4l2_frequency *freq)
  679. {
  680. struct si470x_device *radio = video_drvdata(file);
  681. int retval = 0;
  682. /* safety checks */
  683. mutex_lock(&radio->lock);
  684. retval = si470x_disconnect_check(radio);
  685. if (retval)
  686. goto done;
  687. if (freq->tuner != 0) {
  688. retval = -EINVAL;
  689. goto done;
  690. }
  691. freq->type = V4L2_TUNER_RADIO;
  692. retval = si470x_get_freq(radio, &freq->frequency);
  693. done:
  694. if (retval < 0)
  695. dev_warn(&radio->videodev->dev,
  696. "get frequency failed with %d\n", retval);
  697. mutex_unlock(&radio->lock);
  698. return retval;
  699. }
  700. /*
  701. * si470x_vidioc_s_frequency - set tuner or modulator radio frequency
  702. */
  703. static int si470x_vidioc_s_frequency(struct file *file, void *priv,
  704. struct v4l2_frequency *freq)
  705. {
  706. struct si470x_device *radio = video_drvdata(file);
  707. int retval = 0;
  708. mutex_lock(&radio->lock);
  709. /* safety checks */
  710. retval = si470x_disconnect_check(radio);
  711. if (retval)
  712. goto done;
  713. if (freq->tuner != 0) {
  714. retval = -EINVAL;
  715. goto done;
  716. }
  717. retval = si470x_set_freq(radio, freq->frequency);
  718. done:
  719. if (retval < 0)
  720. dev_warn(&radio->videodev->dev,
  721. "set frequency failed with %d\n", retval);
  722. mutex_unlock(&radio->lock);
  723. return retval;
  724. }
  725. /*
  726. * si470x_vidioc_s_hw_freq_seek - set hardware frequency seek
  727. */
  728. static int si470x_vidioc_s_hw_freq_seek(struct file *file, void *priv,
  729. struct v4l2_hw_freq_seek *seek)
  730. {
  731. struct si470x_device *radio = video_drvdata(file);
  732. int retval = 0;
  733. mutex_lock(&radio->lock);
  734. /* safety checks */
  735. retval = si470x_disconnect_check(radio);
  736. if (retval)
  737. goto done;
  738. if (seek->tuner != 0) {
  739. retval = -EINVAL;
  740. goto done;
  741. }
  742. retval = si470x_set_seek(radio, seek->wrap_around, seek->seek_upward);
  743. done:
  744. if (retval < 0)
  745. dev_warn(&radio->videodev->dev,
  746. "set hardware frequency seek failed with %d\n", retval);
  747. mutex_unlock(&radio->lock);
  748. return retval;
  749. }
  750. /*
  751. * si470x_ioctl_ops - video device ioctl operations
  752. */
  753. static const struct v4l2_ioctl_ops si470x_ioctl_ops = {
  754. .vidioc_querycap = si470x_vidioc_querycap,
  755. .vidioc_queryctrl = si470x_vidioc_queryctrl,
  756. .vidioc_g_ctrl = si470x_vidioc_g_ctrl,
  757. .vidioc_s_ctrl = si470x_vidioc_s_ctrl,
  758. .vidioc_g_audio = si470x_vidioc_g_audio,
  759. .vidioc_g_tuner = si470x_vidioc_g_tuner,
  760. .vidioc_s_tuner = si470x_vidioc_s_tuner,
  761. .vidioc_g_frequency = si470x_vidioc_g_frequency,
  762. .vidioc_s_frequency = si470x_vidioc_s_frequency,
  763. .vidioc_s_hw_freq_seek = si470x_vidioc_s_hw_freq_seek,
  764. };
  765. /*
  766. * si470x_viddev_template - video device interface
  767. */
  768. struct video_device si470x_viddev_template = {
  769. .fops = &si470x_fops,
  770. .name = DRIVER_NAME,
  771. .release = video_device_release,
  772. .ioctl_ops = &si470x_ioctl_ops,
  773. };