aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/media/radio/si470x/radio-si470x-common.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/media/radio/si470x/radio-si470x-common.c')
-rw-r--r--drivers/media/radio/si470x/radio-si470x-common.c794
1 files changed, 794 insertions, 0 deletions
diff --git a/drivers/media/radio/si470x/radio-si470x-common.c b/drivers/media/radio/si470x/radio-si470x-common.c
new file mode 100644
index 000000000000..b64559d561e5
--- /dev/null
+++ b/drivers/media/radio/si470x/radio-si470x-common.c
@@ -0,0 +1,794 @@
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)
187 printk(KERN_WARNING DRIVER_NAME ": tune does not complete\n");
188 if (timed_out)
189 printk(KERN_WARNING DRIVER_NAME
190 ": tune timed out after %u ms\n", tune_timeout);
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)
323 printk(KERN_WARNING DRIVER_NAME ": seek does not complete\n");
324 if (radio->registers[STATUSRSSI] & STATUSRSSI_SF)
325 printk(KERN_WARNING DRIVER_NAME
326 ": seek failed / band limit reached\n");
327 if (timed_out)
328 printk(KERN_WARNING DRIVER_NAME
329 ": seek timed out after %u ms\n", seek_timeout);
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 */
360 radio->registers[SYSCONFIG1] = SYSCONFIG1_DE;
361 retval = si470x_set_register(radio, SYSCONFIG1);
362 if (retval < 0)
363 goto done;
364
365 /* sysconfig 2 */
366 radio->registers[SYSCONFIG2] =
367 (0x3f << 8) | /* SEEKTH */
368 ((band << 6) & SYSCONFIG2_BAND) | /* BAND */
369 ((space << 4) & SYSCONFIG2_SPACE) | /* SPACE */
370 15; /* VOLUME (max) */
371 retval = si470x_set_register(radio, SYSCONFIG2);
372 if (retval < 0)
373 goto done;
374
375 /* reset last channel */
376 retval = si470x_set_chan(radio,
377 radio->registers[CHANNEL] & CHANNEL_CHAN);
378
379done:
380 return retval;
381}
382
383
384/*
385 * si470x_stop - switch off radio
386 */
387int si470x_stop(struct si470x_device *radio)
388{
389 int retval;
390
391 /* sysconfig 1 */
392 radio->registers[SYSCONFIG1] &= ~SYSCONFIG1_RDS;
393 retval = si470x_set_register(radio, SYSCONFIG1);
394 if (retval < 0)
395 goto done;
396
397 /* powercfg */
398 radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
399 /* POWERCFG_ENABLE has to automatically go low */
400 radio->registers[POWERCFG] |= POWERCFG_ENABLE | POWERCFG_DISABLE;
401 retval = si470x_set_register(radio, POWERCFG);
402
403done:
404 return retval;
405}
406
407
408/*
409 * si470x_rds_on - switch on rds reception
410 */
411int si470x_rds_on(struct si470x_device *radio)
412{
413 int retval;
414
415 /* sysconfig 1 */
416 mutex_lock(&radio->lock);
417 radio->registers[SYSCONFIG1] |= SYSCONFIG1_RDS;
418 retval = si470x_set_register(radio, SYSCONFIG1);
419 if (retval < 0)
420 radio->registers[SYSCONFIG1] &= ~SYSCONFIG1_RDS;
421 mutex_unlock(&radio->lock);
422
423 return retval;
424}
425
426
427
428/**************************************************************************
429 * Video4Linux Interface
430 **************************************************************************/
431
432/*
433 * si470x_vidioc_queryctrl - enumerate control items
434 */
435static int si470x_vidioc_queryctrl(struct file *file, void *priv,
436 struct v4l2_queryctrl *qc)
437{
438 int retval = -EINVAL;
439
440 /* abort if qc->id is below V4L2_CID_BASE */
441 if (qc->id < V4L2_CID_BASE)
442 goto done;
443
444 /* search video control */
445 switch (qc->id) {
446 case V4L2_CID_AUDIO_VOLUME:
447 return v4l2_ctrl_query_fill(qc, 0, 15, 1, 15);
448 case V4L2_CID_AUDIO_MUTE:
449 return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);
450 }
451
452 /* disable unsupported base controls */
453 /* to satisfy kradio and such apps */
454 if ((retval == -EINVAL) && (qc->id < V4L2_CID_LASTP1)) {
455 qc->flags = V4L2_CTRL_FLAG_DISABLED;
456 retval = 0;
457 }
458
459done:
460 if (retval < 0)
461 printk(KERN_WARNING DRIVER_NAME
462 ": query controls failed with %d\n", retval);
463 return retval;
464}
465
466
467/*
468 * si470x_vidioc_g_ctrl - get the value of a control
469 */
470static int si470x_vidioc_g_ctrl(struct file *file, void *priv,
471 struct v4l2_control *ctrl)
472{
473 struct si470x_device *radio = video_drvdata(file);
474 int retval = 0;
475
476 /* safety checks */
477 if (radio->disconnected) {
478 retval = -EIO;
479 goto done;
480 }
481
482 switch (ctrl->id) {
483 case V4L2_CID_AUDIO_VOLUME:
484 ctrl->value = radio->registers[SYSCONFIG2] &
485 SYSCONFIG2_VOLUME;
486 break;
487 case V4L2_CID_AUDIO_MUTE:
488 ctrl->value = ((radio->registers[POWERCFG] &
489 POWERCFG_DMUTE) == 0) ? 1 : 0;
490 break;
491 default:
492 retval = -EINVAL;
493 }
494
495done:
496 if (retval < 0)
497 printk(KERN_WARNING DRIVER_NAME
498 ": get control failed with %d\n", retval);
499 return retval;
500}
501
502
503/*
504 * si470x_vidioc_s_ctrl - set the value of a control
505 */
506static int si470x_vidioc_s_ctrl(struct file *file, void *priv,
507 struct v4l2_control *ctrl)
508{
509 struct si470x_device *radio = video_drvdata(file);
510 int retval = 0;
511
512 /* safety checks */
513 if (radio->disconnected) {
514 retval = -EIO;
515 goto done;
516 }
517
518 switch (ctrl->id) {
519 case V4L2_CID_AUDIO_VOLUME:
520 radio->registers[SYSCONFIG2] &= ~SYSCONFIG2_VOLUME;
521 radio->registers[SYSCONFIG2] |= ctrl->value;
522 retval = si470x_set_register(radio, SYSCONFIG2);
523 break;
524 case V4L2_CID_AUDIO_MUTE:
525 if (ctrl->value == 1)
526 radio->registers[POWERCFG] &= ~POWERCFG_DMUTE;
527 else
528 radio->registers[POWERCFG] |= POWERCFG_DMUTE;
529 retval = si470x_set_register(radio, POWERCFG);
530 break;
531 default:
532 retval = -EINVAL;
533 }
534
535done:
536 if (retval < 0)
537 printk(KERN_WARNING DRIVER_NAME
538 ": set control failed with %d\n", retval);
539 return retval;
540}
541
542
543/*
544 * si470x_vidioc_g_audio - get audio attributes
545 */
546static int si470x_vidioc_g_audio(struct file *file, void *priv,
547 struct v4l2_audio *audio)
548{
549 /* driver constants */
550 audio->index = 0;
551 strcpy(audio->name, "Radio");
552 audio->capability = V4L2_AUDCAP_STEREO;
553 audio->mode = 0;
554
555 return 0;
556}
557
558
559/*
560 * si470x_vidioc_g_tuner - get tuner attributes
561 */
562static int si470x_vidioc_g_tuner(struct file *file, void *priv,
563 struct v4l2_tuner *tuner)
564{
565 struct si470x_device *radio = video_drvdata(file);
566 int retval = 0;
567
568 /* safety checks */
569 if (radio->disconnected) {
570 retval = -EIO;
571 goto done;
572 }
573 if (tuner->index != 0) {
574 retval = -EINVAL;
575 goto done;
576 }
577
578 retval = si470x_get_register(radio, STATUSRSSI);
579 if (retval < 0)
580 goto done;
581
582 /* driver constants */
583 strcpy(tuner->name, "FM");
584 tuner->type = V4L2_TUNER_RADIO;
585 tuner->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
586 V4L2_TUNER_CAP_RDS;
587
588 /* range limits */
589 switch ((radio->registers[SYSCONFIG2] & SYSCONFIG2_BAND) >> 6) {
590 /* 0: 87.5 - 108 MHz (USA, Europe, default) */
591 default:
592 tuner->rangelow = 87.5 * FREQ_MUL;
593 tuner->rangehigh = 108 * FREQ_MUL;
594 break;
595 /* 1: 76 - 108 MHz (Japan wide band) */
596 case 1:
597 tuner->rangelow = 76 * FREQ_MUL;
598 tuner->rangehigh = 108 * FREQ_MUL;
599 break;
600 /* 2: 76 - 90 MHz (Japan) */
601 case 2:
602 tuner->rangelow = 76 * FREQ_MUL;
603 tuner->rangehigh = 90 * FREQ_MUL;
604 break;
605 };
606
607 /* stereo indicator == stereo (instead of mono) */
608 if ((radio->registers[STATUSRSSI] & STATUSRSSI_ST) == 0)
609 tuner->rxsubchans = V4L2_TUNER_SUB_MONO;
610 else
611 tuner->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
612 /* If there is a reliable method of detecting an RDS channel,
613 then this code should check for that before setting this
614 RDS subchannel. */
615 tuner->rxsubchans |= V4L2_TUNER_SUB_RDS;
616
617 /* mono/stereo selector */
618 if ((radio->registers[POWERCFG] & POWERCFG_MONO) == 0)
619 tuner->audmode = V4L2_TUNER_MODE_STEREO;
620 else
621 tuner->audmode = V4L2_TUNER_MODE_MONO;
622
623 /* min is worst, max is best; signal:0..0xffff; rssi: 0..0xff */
624 /* measured in units of db쨉V in 1 db increments (max at ~75 db쨉V) */
625 tuner->signal = (radio->registers[STATUSRSSI] & STATUSRSSI_RSSI);
626 /* the ideal factor is 0xffff/75 = 873,8 */
627 tuner->signal = (tuner->signal * 873) + (8 * tuner->signal / 10);
628
629 /* automatic frequency control: -1: freq to low, 1 freq to high */
630 /* AFCRL does only indicate that freq. differs, not if too low/high */
631 tuner->afc = (radio->registers[STATUSRSSI] & STATUSRSSI_AFCRL) ? 1 : 0;
632
633done:
634 if (retval < 0)
635 printk(KERN_WARNING DRIVER_NAME
636 ": get tuner failed with %d\n", retval);
637 return retval;
638}
639
640
641/*
642 * si470x_vidioc_s_tuner - set tuner attributes
643 */
644static int si470x_vidioc_s_tuner(struct file *file, void *priv,
645 struct v4l2_tuner *tuner)
646{
647 struct si470x_device *radio = video_drvdata(file);
648 int retval = -EINVAL;
649
650 /* safety checks */
651 if (radio->disconnected) {
652 retval = -EIO;
653 goto done;
654 }
655 if (tuner->index != 0)
656 goto done;
657
658 /* mono/stereo selector */
659 switch (tuner->audmode) {
660 case V4L2_TUNER_MODE_MONO:
661 radio->registers[POWERCFG] |= POWERCFG_MONO; /* force mono */
662 break;
663 case V4L2_TUNER_MODE_STEREO:
664 radio->registers[POWERCFG] &= ~POWERCFG_MONO; /* try stereo */
665 break;
666 default:
667 goto done;
668 }
669
670 retval = si470x_set_register(radio, POWERCFG);
671
672done:
673 if (retval < 0)
674 printk(KERN_WARNING DRIVER_NAME
675 ": set tuner failed with %d\n", retval);
676 return retval;
677}
678
679
680/*
681 * si470x_vidioc_g_frequency - get tuner or modulator radio frequency
682 */
683static int si470x_vidioc_g_frequency(struct file *file, void *priv,
684 struct v4l2_frequency *freq)
685{
686 struct si470x_device *radio = video_drvdata(file);
687 int retval = 0;
688
689 /* safety checks */
690 if (radio->disconnected) {
691 retval = -EIO;
692 goto done;
693 }
694 if (freq->tuner != 0) {
695 retval = -EINVAL;
696 goto done;
697 }
698
699 freq->type = V4L2_TUNER_RADIO;
700 retval = si470x_get_freq(radio, &freq->frequency);
701
702done:
703 if (retval < 0)
704 printk(KERN_WARNING DRIVER_NAME
705 ": get frequency failed with %d\n", retval);
706 return retval;
707}
708
709
710/*
711 * si470x_vidioc_s_frequency - set tuner or modulator radio frequency
712 */
713static int si470x_vidioc_s_frequency(struct file *file, void *priv,
714 struct v4l2_frequency *freq)
715{
716 struct si470x_device *radio = video_drvdata(file);
717 int retval = 0;
718
719 /* safety checks */
720 if (radio->disconnected) {
721 retval = -EIO;
722 goto done;
723 }
724 if (freq->tuner != 0) {
725 retval = -EINVAL;
726 goto done;
727 }
728
729 retval = si470x_set_freq(radio, freq->frequency);
730
731done:
732 if (retval < 0)
733 printk(KERN_WARNING DRIVER_NAME
734 ": set frequency failed with %d\n", retval);
735 return retval;
736}
737
738
739/*
740 * si470x_vidioc_s_hw_freq_seek - set hardware frequency seek
741 */
742static int si470x_vidioc_s_hw_freq_seek(struct file *file, void *priv,
743 struct v4l2_hw_freq_seek *seek)
744{
745 struct si470x_device *radio = video_drvdata(file);
746 int retval = 0;
747
748 /* safety checks */
749 if (radio->disconnected) {
750 retval = -EIO;
751 goto done;
752 }
753 if (seek->tuner != 0) {
754 retval = -EINVAL;
755 goto done;
756 }
757
758 retval = si470x_set_seek(radio, seek->wrap_around, seek->seek_upward);
759
760done:
761 if (retval < 0)
762 printk(KERN_WARNING DRIVER_NAME
763 ": set hardware frequency seek failed with %d\n",
764 retval);
765 return retval;
766}
767
768
769/*
770 * si470x_ioctl_ops - video device ioctl operations
771 */
772static const struct v4l2_ioctl_ops si470x_ioctl_ops = {
773 .vidioc_querycap = si470x_vidioc_querycap,
774 .vidioc_queryctrl = si470x_vidioc_queryctrl,
775 .vidioc_g_ctrl = si470x_vidioc_g_ctrl,
776 .vidioc_s_ctrl = si470x_vidioc_s_ctrl,
777 .vidioc_g_audio = si470x_vidioc_g_audio,
778 .vidioc_g_tuner = si470x_vidioc_g_tuner,
779 .vidioc_s_tuner = si470x_vidioc_s_tuner,
780 .vidioc_g_frequency = si470x_vidioc_g_frequency,
781 .vidioc_s_frequency = si470x_vidioc_s_frequency,
782 .vidioc_s_hw_freq_seek = si470x_vidioc_s_hw_freq_seek,
783};
784
785
786/*
787 * si470x_viddev_template - video device interface
788 */
789struct video_device si470x_viddev_template = {
790 .fops = &si470x_fops,
791 .name = DRIVER_NAME,
792 .release = video_device_release,
793 .ioctl_ops = &si470x_ioctl_ops,
794};
generated by cgit v1.2.2 (git 2.25.0) at 2025-01-24 02:56:21 -0500