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