projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
[media] double mutex lock in drivers/media/radio/si470x/radio-si470x-
[linux-2.6-block.git] / drivers / media / radio / si470x / radio-si470x-common.c
CommitLineData
b09cd163
JS		 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
24/*
25 * History:
26 * 2008-01-12 Tobias Lorenz <tobias.lorenz@gmx.net>
27 * Version 1.0.0
28 * - First working version
29 * 2008-01-13 Tobias Lorenz <tobias.lorenz@gmx.net>
30 * Version 1.0.1
31 * - Improved error handling, every function now returns errno
32 * - Improved multi user access (start/mute/stop)
33 * - Channel doesn't get lost anymore after start/mute/stop
34 * - RDS support added (polling mode via interrupt EP 1)
35 * - marked default module parameters with *value*
36 * - switched from bit structs to bit masks
37 * - header file cleaned and integrated
38 * 2008-01-14 Tobias Lorenz <tobias.lorenz@gmx.net>
39 * Version 1.0.2
40 * - hex values are now lower case
41 * - commented USB ID for ADS/Tech moved on todo list
42 * - blacklisted si470x in hid-quirks.c
43 * - rds buffer handling functions integrated into *_work, *_read
44 * - rds_command in si470x_poll exchanged against simple retval
45 * - check for firmware version 15
46 * - code order and prototypes still remain the same
47 * - spacing and bottom of band codes remain the same
48 * 2008-01-16 Tobias Lorenz <tobias.lorenz@gmx.net>
49 * Version 1.0.3
50 * - code reordered to avoid function prototypes
51 * - switch/case defaults are now more user-friendly
52 * - unified comment style
53 * - applied all checkpatch.pl v1.12 suggestions
54 * except the warning about the too long lines with bit comments
55 * - renamed FMRADIO to RADIO to cut line length (checkpatch.pl)
56 * 2008-01-22 Tobias Lorenz <tobias.lorenz@gmx.net>
57 * Version 1.0.4
58 * - avoid poss. locking when doing copy_to_user which may sleep
59 * - RDS is automatically activated on read now
60 * - code cleaned of unnecessary rds_commands
61 * - USB Vendor/Product ID for ADS/Tech FM Radio Receiver verified
62 * (thanks to Guillaume RAMOUSSE)
63 * 2008-01-27 Tobias Lorenz <tobias.lorenz@gmx.net>
64 * Version 1.0.5
65 * - number of seek_retries changed to tune_timeout
66 * - fixed problem with incomplete tune operations by own buffers
67 * - optimization of variables and printf types
68 * - improved error logging
69 * 2008-01-31 Tobias Lorenz <tobias.lorenz@gmx.net>
70 * Oliver Neukum <oliver@neukum.org>
71 * Version 1.0.6
72 * - fixed coverity checker warnings in *_usb_driver_disconnect
73 * - probe()/open() race by correct ordering in probe()
74 * - DMA coherency rules by separate allocation of all buffers
75 * - use of endianness macros
76 * - abuse of spinlock, replaced by mutex
77 * - racy handling of timer in disconnect,
78 * replaced by delayed_work
79 * - racy interruptible_sleep_on(),
80 * replaced with wait_event_interruptible()
81 * - handle signals in read()
82 * 2008-02-08 Tobias Lorenz <tobias.lorenz@gmx.net>
83 * Oliver Neukum <oliver@neukum.org>
84 * Version 1.0.7
85 * - usb autosuspend support
86 * - unplugging fixed
87 * 2008-05-07 Tobias Lorenz <tobias.lorenz@gmx.net>
88 * Version 1.0.8
89 * - hardware frequency seek support
90 * - afc indication
91 * - more safety checks, let si470x_get_freq return errno
92 * - vidioc behavior corrected according to v4l2 spec
93 * 2008-10-20 Alexey Klimov <klimov.linux@gmail.com>
94 * - add support for KWorld USB FM Radio FM700
95 * - blacklisted KWorld radio in hid-core.c and hid-ids.h
96 * 2008-12-03 Mark Lord <mlord@pobox.com>
97 * - add support for DealExtreme USB Radio
98 * 2009-01-31 Bob Ross <pigiron@gmx.com>
99 * - correction of stereo detection/setting
100 * - correction of signal strength indicator scaling
101 * 2009-01-31 Rick Bronson <rick@efn.org>
102 * Tobias Lorenz <tobias.lorenz@gmx.net>
103 * - add LED status output
104 * - get HW/SW version from scratchpad
105 * 2009-06-16 Edouard Lafargue <edouard@lafargue.name>
106 * Version 1.0.10
107 * - add support for interrupt mode for RDS endpoint,
108 * instead of polling.
109 * Improves RDS reception significantly
110 */
111
112
113/* kernel includes */
114#include "radio-si470x.h"
115
116
117
118/**************************************************************************
119 * Module Parameters
120 **************************************************************************/
121
122/* Spacing (kHz) */
123/* 0: 200 kHz (USA, Australia) */
124/* 1: 100 kHz (Europe, Japan) */
125/* 2: 50 kHz */
126static unsigned short space = 2;
127module_param(space, ushort, 0444);
128MODULE_PARM_DESC(space, "Spacing: 0=200kHz 1=100kHz *2=50kHz*");
129
130/* Bottom of Band (MHz) */
131/* 0: 87.5 - 108 MHz (USA, Europe)*/
132/* 1: 76 - 108 MHz (Japan wide band) */
133/* 2: 76 - 90 MHz (Japan) */
134static unsigned short band = 1;
135module_param(band, ushort, 0444);
136MODULE_PARM_DESC(band, "Band: 0=87.5..108MHz *1=76..108MHz* 2=76..90MHz");
137
138/* De-emphasis */
139/* 0: 75 us (USA) */
140/* 1: 50 us (Europe, Australia, Japan) */
141static unsigned short de = 1;
142module_param(de, ushort, 0444);
143MODULE_PARM_DESC(de, "De-emphasis: 0=75us *1=50us*");
144
145/* Tune timeout */
146static unsigned int tune_timeout = 3000;
147module_param(tune_timeout, uint, 0644);
148MODULE_PARM_DESC(tune_timeout, "Tune timeout: *3000*");
149
150/* Seek timeout */
151static unsigned int seek_timeout = 5000;
152module_param(seek_timeout, uint, 0644);
153MODULE_PARM_DESC(seek_timeout, "Seek timeout: *5000*");
154
155
156
157/**************************************************************************
158 * Generic Functions
159 **************************************************************************/
160
161/*
162 * si470x_set_chan - set the channel
163 */
164static int si470x_set_chan(struct si470x_device *radio, unsigned short chan)
165{
166 int retval;
167 unsigned long timeout;
168 bool timed_out = 0;
169
170 /* start tuning */
171 radio->registers[CHANNEL] &= ~CHANNEL_CHAN;
172 radio->registers[CHANNEL] |= CHANNEL_TUNE | chan;
173 retval = si470x_set_register(radio, CHANNEL);
174 if (retval < 0)
175 goto done;
176
177 /* wait till tune operation has completed */
178 timeout = jiffies + msecs_to_jiffies(tune_timeout);
179 do {
180 retval = si470x_get_register(radio, STATUSRSSI);
181 if (retval < 0)
182 goto stop;
183 timed_out = time_after(jiffies, timeout);
184 } while (((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0) &&
185 (!timed_out));
186 if ((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0)
a9d6fd5e 187 dev_warn(&radio->videodev->dev, "tune does not complete\n");
b09cd163 188 if (timed_out)
a9d6fd5e
JS		 189 dev_warn(&radio->videodev->dev,
190 "tune timed out after %u ms\n", tune_timeout);
b09cd163
JS		 191
192stop:
193 /* stop tuning */
194 radio->registers[CHANNEL] &= ~CHANNEL_TUNE;
195 retval = si470x_set_register(radio, CHANNEL);
196
197done:
198 return retval;
199}
200
201
202/*
203 * si470x_get_freq - get the frequency
204 */
205static int si470x_get_freq(struct si470x_device *radio, unsigned int *freq)
206{
207 unsigned int spacing, band_bottom;
208 unsigned short chan;
209 int retval;
210
211 /* Spacing (kHz) */
212 switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_SPACE) >> 4) {
213 /* 0: 200 kHz (USA, Australia) */
214 case 0:
215 spacing = 0.200 * FREQ_MUL; break;
216 /* 1: 100 kHz (Europe, Japan) */
217 case 1:
218 spacing = 0.100 * FREQ_MUL; break;
219 /* 2: 50 kHz */
220 default:
221 spacing = 0.050 * FREQ_MUL; break;
222 };
223
224 /* Bottom of Band (MHz) */
225 switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
226 /* 0: 87.5 - 108 MHz (USA, Europe) */
227 case 0:
228 band_bottom = 87.5 * FREQ_MUL; break;
229 /* 1: 76 - 108 MHz (Japan wide band) */
230 default:
231 band_bottom = 76 * FREQ_MUL; break;
232 /* 2: 76 - 90 MHz (Japan) */
233 case 2:
234 band_bottom = 76 * FREQ_MUL; break;
235 };
236
237 /* read channel */
238 retval = si470x_get_register(radio, READCHAN);
239 chan = radio->registers[READCHAN] & READCHAN_READCHAN;
240
241 /* Frequency (MHz) = Spacing (kHz) x Channel + Bottom of Band (MHz) */
242 *freq = chan * spacing + band_bottom;
243
244 return retval;
245}
246
247
248/*
249 * si470x_set_freq - set the frequency
250 */
251int si470x_set_freq(struct si470x_device *radio, unsigned int freq)
252{
253 unsigned int spacing, band_bottom;
254 unsigned short chan;
255
256 /* Spacing (kHz) */
257 switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_SPACE) >> 4) {
258 /* 0: 200 kHz (USA, Australia) */
259 case 0:
260 spacing = 0.200 * FREQ_MUL; break;
261 /* 1: 100 kHz (Europe, Japan) */
262 case 1:
263 spacing = 0.100 * FREQ_MUL; break;
264 /* 2: 50 kHz */
265 default:
266 spacing = 0.050 * FREQ_MUL; break;
267 };
268
269 /* Bottom of Band (MHz) */
270 switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
271 /* 0: 87.5 - 108 MHz (USA, Europe) */
272 case 0:
273 band_bottom = 87.5 * FREQ_MUL; break;
274 /* 1: 76 - 108 MHz (Japan wide band) */
275 default:
276 band_bottom = 76 * FREQ_MUL; break;
277 /* 2: 76 - 90 MHz (Japan) */
278 case 2:
279 band_bottom = 76 * FREQ_MUL; break;
280 };
281
282 /* Chan = [ Freq (Mhz) - Bottom of Band (MHz) ] / Spacing (kHz) */
283 chan = (freq - band_bottom) / spacing;
284
285 return si470x_set_chan(radio, chan);
286}
287
288
289/*
290 * si470x_set_seek - set seek
291 */
292static int si470x_set_seek(struct si470x_device *radio,
293 unsigned int wrap_around, unsigned int seek_upward)
294{
295 int retval = 0;
296 unsigned long timeout;
297 bool timed_out = 0;
298
299 /* start seeking */
300 radio->registers[POWERCFG] |= POWERCFG_SEEK;
301 if (wrap_around == 1)
302 radio->registers[POWERCFG] &= ~POWERCFG_SKMODE;
303 else
304 radio->registers[POWERCFG] |= POWERCFG_SKMODE;
305 if (seek_upward == 1)
306 radio->registers[POWERCFG] |= POWERCFG_SEEKUP;
307 else
308 radio->registers[POWERCFG] &= ~POWERCFG_SEEKUP;
309 retval = si470x_set_register(radio, POWERCFG);
310 if (retval < 0)
311 goto done;
312
313 /* wait till seek operation has completed */
314 timeout = jiffies + msecs_to_jiffies(seek_timeout);
315 do {
316 retval = si470x_get_register(radio, STATUSRSSI);
317 if (retval < 0)
318 goto stop;
319 timed_out = time_after(jiffies, timeout);
320 } while (((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0) &&
321 (!timed_out));
322 if ((radio->registers[STATUSRSSI] & STATUSRSSI_STC) == 0)
a9d6fd5e 323 dev_warn(&radio->videodev->dev, "seek does not complete\n");
b09cd163 324 if (radio->registers[STATUSRSSI] & STATUSRSSI_SF)
a9d6fd5e
JS		 325 dev_warn(&radio->videodev->dev,
326 "seek failed / band limit reached\n");
b09cd163 327 if (timed_out)
a9d6fd5e
JS		 328 dev_warn(&radio->videodev->dev,
329 "seek timed out after %u ms\n", seek_timeout);
b09cd163
JS		 330
331stop:
332 /* stop seeking */
333 radio->registers[POWERCFG] &= ~POWERCFG_SEEK;
334 retval = si470x_set_register(radio, POWERCFG);
335
336done:
337 /* try again, if timed out */
338 if ((retval == 0) && timed_out)
339 retval = -EAGAIN;
340
341 return retval;
342}
343
344
345/*
346 * si470x_start - switch on radio
347 */
348int si470x_start(struct si470x_device *radio)
349{
350 int retval;
351
352 /* powercfg */
353 radio->registers[POWERCFG] =
354 POWERCFG_DMUTE | POWERCFG_ENABLE | POWERCFG_RDSM;
355 retval = si470x_set_register(radio, POWERCFG);
356 if (retval < 0)
357 goto done;
358
359 /* sysconfig 1 */
131ddd1a
TL		 360 radio->registers[SYSCONFIG1] =
361 (de << 11) & SYSCONFIG1_DE; /* DE*/
b09cd163
JS		 362 retval = si470x_set_register(radio, SYSCONFIG1);
363 if (retval < 0)
364 goto done;
365
366 /* sysconfig 2 */
367 radio->registers[SYSCONFIG2] =
368 (0x3f << 8) | /* SEEKTH */
369 ((band << 6) & SYSCONFIG2_BAND) | /* BAND */
370 ((space << 4) & SYSCONFIG2_SPACE) | /* SPACE */
371 15; /* VOLUME (max) */
372 retval = si470x_set_register(radio, SYSCONFIG2);
373 if (retval < 0)
374 goto done;
375
376 /* reset last channel */
377 retval = si470x_set_chan(radio,
378 radio->registers[CHANNEL] & CHANNEL_CHAN);
379
380done:
381 return retval;
382}
383
384
385/*
386 * si470x_stop - switch off radio
387 */
388int si470x_stop(struct si470x_device *radio)
389{
390 int retval;
391
392 /* sysconfig 1 */
393 radio->registers[SYSCONFIG1] &= ~SYSCONFIG1_RDS;
394 retval = si470x_set_register(radio, SYSCONFIG1);
395 if (retval < 0)
396 goto done;
397
398 /* powercfg */
399 radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
400 /* POWERCFG_ENABLE has to automatically go low */
401 radio->registers[POWERCFG] |= POWERCFG_ENABLE | POWERCFG_DISABLE;
402 retval = si470x_set_register(radio, POWERCFG);
403
404done:
405 return retval;
406}
407
408
409/*
410 * si470x_rds_on - switch on rds reception
411 */
f2f8e850 412static int si470x_rds_on(struct si470x_device *radio)
b09cd163
JS		 413{
414 int retval;
415
416 /* sysconfig 1 */
b09cd163
JS		 417 radio->registers[SYSCONFIG1] |= SYSCONFIG1_RDS;
418 retval = si470x_set_register(radio, SYSCONFIG1);
419 if (retval < 0)
420 radio->registers[SYSCONFIG1] &= ~SYSCONFIG1_RDS;
b09cd163
JS		 421
422 return retval;
423}
424
425
426
1aa925c9
JS		 427/**************************************************************************
428 * File Operations Interface
429 **************************************************************************/
430
431/*
432 * si470x_fops_read - read RDS data
433 */
434static ssize_t si470x_fops_read(struct file *file, char __user *buf,
435 size_t count, loff_t *ppos)
436{
437 struct si470x_device *radio = video_drvdata(file);
438 int retval = 0;
439 unsigned int block_count = 0;
440
441 /* switch on rds reception */
f2f8e850 442 mutex_lock(&radio->lock);
1aa925c9
JS		 443 if ((radio->registers[SYSCONFIG1] & SYSCONFIG1_RDS) == 0)
444 si470x_rds_on(radio);
445
446 /* block if no new data available */
447 while (radio->wr_index == radio->rd_index) {
448 if (file->f_flags & O_NONBLOCK) {
449 retval = -EWOULDBLOCK;
450 goto done;
451 }
452 if (wait_event_interruptible(radio->read_queue,
453 radio->wr_index != radio->rd_index) < 0) {
454 retval = -EINTR;
455 goto done;
456 }
457 }
458
459 /* calculate block count from byte count */
460 count /= 3;
461
462 /* copy RDS block out of internal buffer and to user buffer */
1aa925c9
JS		 463 while (block_count < count) {
464 if (radio->rd_index == radio->wr_index)
465 break;
466
467 /* always transfer rds complete blocks */
468 if (copy_to_user(buf, &radio->buffer[radio->rd_index], 3))
469 /* retval = -EFAULT; */
470 break;
471
472 /* increment and wrap read pointer */
473 radio->rd_index += 3;
474 if (radio->rd_index >= radio->buf_size)
475 radio->rd_index = 0;
476
477 /* increment counters */
478 block_count++;
479 buf += 3;
480 retval += 3;
481 }
1aa925c9
JS		 482
483done:
f2f8e850 484 mutex_unlock(&radio->lock);
1aa925c9
JS		 485 return retval;
486}
487
488
489/*
490 * si470x_fops_poll - poll RDS data
491 */
492static unsigned int si470x_fops_poll(struct file *file,
493 struct poll_table_struct *pts)
494{
495 struct si470x_device *radio = video_drvdata(file);
496 int retval = 0;
497
498 /* switch on rds reception */
f2f8e850
MCC		 499
500 mutex_lock(&radio->lock);
1aa925c9
JS		 501 if ((radio->registers[SYSCONFIG1] & SYSCONFIG1_RDS) == 0)
502 si470x_rds_on(radio);
f2f8e850 503 mutex_unlock(&radio->lock);
1aa925c9
JS		 504
505 poll_wait(file, &radio->read_queue, pts);
506
507 if (radio->rd_index != radio->wr_index)
508 retval = POLLIN | POLLRDNORM;
509
510 return retval;
511}
512
513
514/*
515 * si470x_fops - file operations interface
516 */
517static const struct v4l2_file_operations si470x_fops = {
518 .owner = THIS_MODULE,
519 .read = si470x_fops_read,
520 .poll = si470x_fops_poll,
f2f8e850 521 .unlocked_ioctl = video_ioctl2,
1aa925c9
JS		 522 .open = si470x_fops_open,
523 .release = si470x_fops_release,
524};
525
526
527
b09cd163
JS		 528/**************************************************************************
529 * Video4Linux Interface
530 **************************************************************************/
531
532/*
533 * si470x_vidioc_queryctrl - enumerate control items
534 */
535static int si470x_vidioc_queryctrl(struct file *file, void *priv,
536 struct v4l2_queryctrl *qc)
537{
a9d6fd5e 538 struct si470x_device *radio = video_drvdata(file);
b09cd163
JS		 539 int retval = -EINVAL;
540
541 /* abort if qc->id is below V4L2_CID_BASE */
542 if (qc->id < V4L2_CID_BASE)
543 goto done;
544
545 /* search video control */
546 switch (qc->id) {
547 case V4L2_CID_AUDIO_VOLUME:
548 return v4l2_ctrl_query_fill(qc, 0, 15, 1, 15);
549 case V4L2_CID_AUDIO_MUTE:
550 return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);
551 }
552
553 /* disable unsupported base controls */
554 /* to satisfy kradio and such apps */
555 if ((retval == -EINVAL) && (qc->id < V4L2_CID_LASTP1)) {
556 qc->flags = V4L2_CTRL_FLAG_DISABLED;
557 retval = 0;
558 }
559
560done:
561 if (retval < 0)
a9d6fd5e
JS		 562 dev_warn(&radio->videodev->dev,
563 "query controls failed with %d\n", retval);
b09cd163
JS		 564 return retval;
565}
566
567
568/*
569 * si470x_vidioc_g_ctrl - get the value of a control
570 */
571static int si470x_vidioc_g_ctrl(struct file *file, void *priv,
572 struct v4l2_control *ctrl)
573{
574 struct si470x_device *radio = video_drvdata(file);
575 int retval = 0;
576
f2f8e850 577 mutex_lock(&radio->lock);
b09cd163 578 /* safety checks */
3c7cc8d5
JS		 579 retval = si470x_disconnect_check(radio);
580 if (retval)
b09cd163 581 goto done;
b09cd163
JS		 582
583 switch (ctrl->id) {
584 case V4L2_CID_AUDIO_VOLUME:
585 ctrl->value = radio->registers[SYSCONFIG2] &
586 SYSCONFIG2_VOLUME;
587 break;
588 case V4L2_CID_AUDIO_MUTE:
589 ctrl->value = ((radio->registers[POWERCFG] &
590 POWERCFG_DMUTE) == 0) ? 1 : 0;
591 break;
592 default:
593 retval = -EINVAL;
594 }
595
596done:
597 if (retval < 0)
a9d6fd5e
JS		 598 dev_warn(&radio->videodev->dev,
599 "get control failed with %d\n", retval);
f2f8e850
MCC		 600
601 mutex_unlock(&radio->lock);
b09cd163
JS		 602 return retval;
603}
604
605
606/*
607 * si470x_vidioc_s_ctrl - set the value of a control
608 */
609static int si470x_vidioc_s_ctrl(struct file *file, void *priv,
610 struct v4l2_control *ctrl)
611{
612 struct si470x_device *radio = video_drvdata(file);
613 int retval = 0;
614
f2f8e850 615 mutex_lock(&radio->lock);
b09cd163 616 /* safety checks */
3c7cc8d5
JS		 617 retval = si470x_disconnect_check(radio);
618 if (retval)
b09cd163 619 goto done;
b09cd163
JS		 620
621 switch (ctrl->id) {
622 case V4L2_CID_AUDIO_VOLUME:
623 radio->registers[SYSCONFIG2] &= ~SYSCONFIG2_VOLUME;
624 radio->registers[SYSCONFIG2] |= ctrl->value;
625 retval = si470x_set_register(radio, SYSCONFIG2);
626 break;
627 case V4L2_CID_AUDIO_MUTE:
628 if (ctrl->value == 1)
629 radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
630 else
631 radio->registers[POWERCFG] |= POWERCFG_DMUTE;
632 retval = si470x_set_register(radio, POWERCFG);
633 break;
634 default:
635 retval = -EINVAL;
636 }
637
638done:
639 if (retval < 0)
a9d6fd5e
JS		 640 dev_warn(&radio->videodev->dev,
641 "set control failed with %d\n", retval);
f2f8e850 642 mutex_unlock(&radio->lock);
b09cd163
JS		 643 return retval;
644}
645
646
647/*
648 * si470x_vidioc_g_audio - get audio attributes
649 */
650static int si470x_vidioc_g_audio(struct file *file, void *priv,
651 struct v4l2_audio *audio)
652{
653 /* driver constants */
654 audio->index = 0;
655 strcpy(audio->name, "Radio");
656 audio->capability = V4L2_AUDCAP_STEREO;
657 audio->mode = 0;
658
659 return 0;
660}
661
662
663/*
664 * si470x_vidioc_g_tuner - get tuner attributes
665 */
666static int si470x_vidioc_g_tuner(struct file *file, void *priv,
667 struct v4l2_tuner *tuner)
668{
669 struct si470x_device *radio = video_drvdata(file);
670 int retval = 0;
671
f2f8e850 672 mutex_lock(&radio->lock);
b09cd163 673 /* safety checks */
3c7cc8d5
JS		 674 retval = si470x_disconnect_check(radio);
675 if (retval)
b09cd163 676 goto done;
3c7cc8d5 677
b09cd163
JS		 678 if (tuner->index != 0) {
679 retval = -EINVAL;
680 goto done;
681 }
682
683 retval = si470x_get_register(radio, STATUSRSSI);
684 if (retval < 0)
685 goto done;
686
687 /* driver constants */
688 strcpy(tuner->name, "FM");
689 tuner->type = V4L2_TUNER_RADIO;
690 tuner->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
cb0ed222 691 V4L2_TUNER_CAP_RDS | V4L2_TUNER_CAP_RDS_BLOCK_IO;
b09cd163
JS		 692
693 /* range limits */
694 switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
695 /* 0: 87.5 - 108 MHz (USA, Europe, default) */
696 default:
697 tuner->rangelow = 87.5 * FREQ_MUL;
698 tuner->rangehigh = 108 * FREQ_MUL;
699 break;
700 /* 1: 76 - 108 MHz (Japan wide band) */
701 case 1:
702 tuner->rangelow = 76 * FREQ_MUL;
703 tuner->rangehigh = 108 * FREQ_MUL;
704 break;
705 /* 2: 76 - 90 MHz (Japan) */
706 case 2:
707 tuner->rangelow = 76 * FREQ_MUL;
708 tuner->rangehigh = 90 * FREQ_MUL;
709 break;
710 };
711
712 /* stereo indicator == stereo (instead of mono) */
713 if ((radio->registers[STATUSRSSI] & STATUSRSSI_ST) == 0)
714 tuner->rxsubchans = V4L2_TUNER_SUB_MONO;
715 else
716 tuner->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
717 /* If there is a reliable method of detecting an RDS channel,
718 then this code should check for that before setting this
719 RDS subchannel. */
720 tuner->rxsubchans |= V4L2_TUNER_SUB_RDS;
721
722 /* mono/stereo selector */
723 if ((radio->registers[POWERCFG] & POWERCFG_MONO) == 0)
724 tuner->audmode = V4L2_TUNER_MODE_STEREO;
725 else
726 tuner->audmode = V4L2_TUNER_MODE_MONO;
727
728 /* min is worst, max is best; signal:0..0xffff; rssi: 0..0xff */
144dcdce 729 /* measured in units of dbµV in 1 db increments (max at ~75 dbµV) */
b09cd163
JS		 730 tuner->signal = (radio->registers[STATUSRSSI] & STATUSRSSI_RSSI);
731 /* the ideal factor is 0xffff/75 = 873,8 */
732 tuner->signal = (tuner->signal * 873) + (8 * tuner->signal / 10);
733
734 /* automatic frequency control: -1: freq to low, 1 freq to high */
735 /* AFCRL does only indicate that freq. differs, not if too low/high */
736 tuner->afc = (radio->registers[STATUSRSSI] & STATUSRSSI_AFCRL) ? 1 : 0;
737
738done:
739 if (retval < 0)
a9d6fd5e
JS		 740 dev_warn(&radio->videodev->dev,
741 "get tuner failed with %d\n", retval);
f2f8e850 742 mutex_unlock(&radio->lock);
b09cd163
JS		 743 return retval;
744}
745
746
747/*
748 * si470x_vidioc_s_tuner - set tuner attributes
749 */
750static int si470x_vidioc_s_tuner(struct file *file, void *priv,
751 struct v4l2_tuner *tuner)
752{
753 struct si470x_device *radio = video_drvdata(file);
73c994e4 754 int retval = 0;
b09cd163 755
f2f8e850 756 mutex_lock(&radio->lock);
b09cd163 757 /* safety checks */
3c7cc8d5
JS		 758 retval = si470x_disconnect_check(radio);
759 if (retval)
b09cd163 760 goto done;
3c7cc8d5 761
b09cd163
JS		 762 if (tuner->index != 0)
763 goto done;
764
765 /* mono/stereo selector */
766 switch (tuner->audmode) {
767 case V4L2_TUNER_MODE_MONO:
768 radio->registers[POWERCFG] |= POWERCFG_MONO; /* force mono */
769 break;
770 case V4L2_TUNER_MODE_STEREO:
771 radio->registers[POWERCFG] &= ~POWERCFG_MONO; /* try stereo */
772 break;
773 default:
774 goto done;
775 }
776
777 retval = si470x_set_register(radio, POWERCFG);
778
779done:
780 if (retval < 0)
a9d6fd5e
JS		 781 dev_warn(&radio->videodev->dev,
782 "set tuner failed with %d\n", retval);
f2f8e850 783 mutex_unlock(&radio->lock);
b09cd163
JS		 784 return retval;
785}
786
787
788/*
789 * si470x_vidioc_g_frequency - get tuner or modulator radio frequency
790 */
791static int si470x_vidioc_g_frequency(struct file *file, void *priv,
792 struct v4l2_frequency *freq)
793{
794 struct si470x_device *radio = video_drvdata(file);
795 int retval = 0;
796
797 /* safety checks */
f2f8e850 798 mutex_lock(&radio->lock);
3c7cc8d5
JS		 799 retval = si470x_disconnect_check(radio);
800 if (retval)
b09cd163 801 goto done;
3c7cc8d5 802
b09cd163
JS		 803 if (freq->tuner != 0) {
804 retval = -EINVAL;
805 goto done;
806 }
807
808 freq->type = V4L2_TUNER_RADIO;
809 retval = si470x_get_freq(radio, &freq->frequency);
810
811done:
812 if (retval < 0)
a9d6fd5e
JS		 813 dev_warn(&radio->videodev->dev,
814 "get frequency failed with %d\n", retval);
f2f8e850 815 mutex_unlock(&radio->lock);
b09cd163
JS		 816 return retval;
817}
818
819
820/*
821 * si470x_vidioc_s_frequency - set tuner or modulator radio frequency
822 */
823static int si470x_vidioc_s_frequency(struct file *file, void *priv,
824 struct v4l2_frequency *freq)
825{
826 struct si470x_device *radio = video_drvdata(file);
827 int retval = 0;
828
f2f8e850 829 mutex_lock(&radio->lock);
b09cd163 830 /* safety checks */
3c7cc8d5
JS		 831 retval = si470x_disconnect_check(radio);
832 if (retval)
b09cd163 833 goto done;
3c7cc8d5 834
b09cd163
JS		 835 if (freq->tuner != 0) {
836 retval = -EINVAL;
837 goto done;
838 }
839
840 retval = si470x_set_freq(radio, freq->frequency);
841
842done:
843 if (retval < 0)
a9d6fd5e
JS		 844 dev_warn(&radio->videodev->dev,
845 "set frequency failed with %d\n", retval);
f2f8e850 846 mutex_unlock(&radio->lock);
b09cd163
JS		 847 return retval;
848}
849
850
851/*
852 * si470x_vidioc_s_hw_freq_seek - set hardware frequency seek
853 */
854static int si470x_vidioc_s_hw_freq_seek(struct file *file, void *priv,
855 struct v4l2_hw_freq_seek *seek)
856{
857 struct si470x_device *radio = video_drvdata(file);
858 int retval = 0;
859
f2f8e850 860 mutex_lock(&radio->lock);
b09cd163 861 /* safety checks */
3c7cc8d5
JS		 862 retval = si470x_disconnect_check(radio);
863 if (retval)
b09cd163 864 goto done;
3c7cc8d5 865
b09cd163
JS		 866 if (seek->tuner != 0) {
867 retval = -EINVAL;
868 goto done;
869 }
870
871 retval = si470x_set_seek(radio, seek->wrap_around, seek->seek_upward);
872
873done:
874 if (retval < 0)
a9d6fd5e
JS		 875 dev_warn(&radio->videodev->dev,
876 "set hardware frequency seek failed with %d\n", retval);
f2f8e850 877 mutex_unlock(&radio->lock);
b09cd163
JS		 878 return retval;
879}
880
881
882/*
883 * si470x_ioctl_ops - video device ioctl operations
884 */
885static const struct v4l2_ioctl_ops si470x_ioctl_ops = {
886 .vidioc_querycap = si470x_vidioc_querycap,
887 .vidioc_queryctrl = si470x_vidioc_queryctrl,
888 .vidioc_g_ctrl = si470x_vidioc_g_ctrl,
889 .vidioc_s_ctrl = si470x_vidioc_s_ctrl,
890 .vidioc_g_audio = si470x_vidioc_g_audio,
891 .vidioc_g_tuner = si470x_vidioc_g_tuner,
892 .vidioc_s_tuner = si470x_vidioc_s_tuner,
893 .vidioc_g_frequency = si470x_vidioc_g_frequency,
894 .vidioc_s_frequency = si470x_vidioc_s_frequency,
895 .vidioc_s_hw_freq_seek = si470x_vidioc_s_hw_freq_seek,
896};
897
898
899/*
900 * si470x_viddev_template - video device interface
901 */
902struct video_device si470x_viddev_template = {
903 .fops = &si470x_fops,
904 .name = DRIVER_NAME,
905 .release = video_device_release,
906 .ioctl_ops = &si470x_ioctl_ops,
907};
Linux 6.x block layer and io_uring tree(s)