blob: 83fe7ab358dfaa6eecc0013f0e3fb1036caeedb8 [file] [log] [blame]
Hans de Goede4faba762012-06-23 04:39:58 -03001/*
2 * v4l2 driver for TEA5777 Philips AM/FM radio tuner chips
3 *
4 * Copyright (c) 2012 Hans de Goede <hdegoede@redhat.com>
5 *
6 * Based on the ALSA driver for TEA5757/5759 Philips AM/FM radio tuner chips:
7 *
8 * Copyright (c) 2004 Jaroslav Kysela <perex@perex.cz>
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 *
24 */
25
26#include <linux/delay.h>
27#include <linux/init.h>
28#include <linux/module.h>
29#include <linux/sched.h>
30#include <linux/slab.h>
31#include <media/v4l2-device.h>
32#include <media/v4l2-dev.h>
33#include <media/v4l2-fh.h>
34#include <media/v4l2-ioctl.h>
35#include <media/v4l2-event.h>
36#include "radio-tea5777.h"
37
38MODULE_AUTHOR("Hans de Goede <perex@perex.cz>");
39MODULE_DESCRIPTION("Routines for control of TEA5777 Philips AM/FM radio tuner chips");
40MODULE_LICENSE("GPL");
41
Hans de Goede4faba762012-06-23 04:39:58 -030042#define TEA5777_FM_IF 150 /* kHz */
Hans de Goeded7aab0b2012-08-10 15:49:59 -030043#define TEA5777_FM_FREQ_STEP 50 /* kHz */
44
45#define TEA5777_AM_IF 21 /* kHz */
46#define TEA5777_AM_FREQ_STEP 1 /* kHz */
Hans de Goede4faba762012-06-23 04:39:58 -030047
48/* Write reg, common bits */
49#define TEA5777_W_MUTE_MASK (1LL << 47)
50#define TEA5777_W_MUTE_SHIFT 47
51#define TEA5777_W_AM_FM_MASK (1LL << 46)
52#define TEA5777_W_AM_FM_SHIFT 46
53#define TEA5777_W_STB_MASK (1LL << 45)
54#define TEA5777_W_STB_SHIFT 45
55
56#define TEA5777_W_IFCE_MASK (1LL << 29)
57#define TEA5777_W_IFCE_SHIFT 29
58#define TEA5777_W_IFW_MASK (1LL << 28)
59#define TEA5777_W_IFW_SHIFT 28
60#define TEA5777_W_HILO_MASK (1LL << 27)
61#define TEA5777_W_HILO_SHIFT 27
62#define TEA5777_W_DBUS_MASK (1LL << 26)
63#define TEA5777_W_DBUS_SHIFT 26
64
65#define TEA5777_W_INTEXT_MASK (1LL << 24)
66#define TEA5777_W_INTEXT_SHIFT 24
67#define TEA5777_W_P1_MASK (1LL << 23)
68#define TEA5777_W_P1_SHIFT 23
69#define TEA5777_W_P0_MASK (1LL << 22)
70#define TEA5777_W_P0_SHIFT 22
71#define TEA5777_W_PEN1_MASK (1LL << 21)
72#define TEA5777_W_PEN1_SHIFT 21
73#define TEA5777_W_PEN0_MASK (1LL << 20)
74#define TEA5777_W_PEN0_SHIFT 20
75
76#define TEA5777_W_CHP0_MASK (1LL << 18)
77#define TEA5777_W_CHP0_SHIFT 18
78#define TEA5777_W_DEEM_MASK (1LL << 17)
79#define TEA5777_W_DEEM_SHIFT 17
80
81#define TEA5777_W_SEARCH_MASK (1LL << 7)
82#define TEA5777_W_SEARCH_SHIFT 7
83#define TEA5777_W_PROGBLIM_MASK (1LL << 6)
84#define TEA5777_W_PROGBLIM_SHIFT 6
85#define TEA5777_W_UPDWN_MASK (1LL << 5)
86#define TEA5777_W_UPDWN_SHIFT 5
87#define TEA5777_W_SLEV_MASK (3LL << 3)
88#define TEA5777_W_SLEV_SHIFT 3
89
90/* Write reg, FM specific bits */
91#define TEA5777_W_FM_PLL_MASK (0x1fffLL << 32)
92#define TEA5777_W_FM_PLL_SHIFT 32
93#define TEA5777_W_FM_FREF_MASK (0x03LL << 30)
94#define TEA5777_W_FM_FREF_SHIFT 30
Hans de Goeded7aab0b2012-08-10 15:49:59 -030095#define TEA5777_W_FM_FREF_VALUE 0LL /* 50k steps, 150k IF */
Hans de Goede4faba762012-06-23 04:39:58 -030096
97#define TEA5777_W_FM_FORCEMONO_MASK (1LL << 15)
98#define TEA5777_W_FM_FORCEMONO_SHIFT 15
99#define TEA5777_W_FM_SDSOFF_MASK (1LL << 14)
100#define TEA5777_W_FM_SDSOFF_SHIFT 14
101#define TEA5777_W_FM_DOFF_MASK (1LL << 13)
102#define TEA5777_W_FM_DOFF_SHIFT 13
103
104#define TEA5777_W_FM_STEP_MASK (3LL << 1)
105#define TEA5777_W_FM_STEP_SHIFT 1
106
107/* Write reg, AM specific bits */
108#define TEA5777_W_AM_PLL_MASK (0x7ffLL << 34)
109#define TEA5777_W_AM_PLL_SHIFT 34
110#define TEA5777_W_AM_AGCRF_MASK (1LL << 33)
111#define TEA5777_W_AM_AGCRF_SHIFT 33
112#define TEA5777_W_AM_AGCIF_MASK (1LL << 32)
113#define TEA5777_W_AM_AGCIF_SHIFT 32
114#define TEA5777_W_AM_MWLW_MASK (1LL << 31)
115#define TEA5777_W_AM_MWLW_SHIFT 31
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300116#define TEA5777_W_AM_LW 0LL
117#define TEA5777_W_AM_MW 1LL
Hans de Goede4faba762012-06-23 04:39:58 -0300118#define TEA5777_W_AM_LNA_MASK (1LL << 30)
119#define TEA5777_W_AM_LNA_SHIFT 30
120
121#define TEA5777_W_AM_PEAK_MASK (1LL << 25)
122#define TEA5777_W_AM_PEAK_SHIFT 25
123
124#define TEA5777_W_AM_RFB_MASK (1LL << 16)
125#define TEA5777_W_AM_RFB_SHIFT 16
126#define TEA5777_W_AM_CALLIGN_MASK (1LL << 15)
127#define TEA5777_W_AM_CALLIGN_SHIFT 15
128#define TEA5777_W_AM_CBANK_MASK (0x7fLL << 8)
129#define TEA5777_W_AM_CBANK_SHIFT 8
130
131#define TEA5777_W_AM_DELAY_MASK (1LL << 2)
132#define TEA5777_W_AM_DELAY_SHIFT 2
133#define TEA5777_W_AM_STEP_MASK (1LL << 1)
134#define TEA5777_W_AM_STEP_SHIFT 1
135
136/* Read reg, common bits */
137#define TEA5777_R_LEVEL_MASK (0x0f << 17)
138#define TEA5777_R_LEVEL_SHIFT 17
139#define TEA5777_R_SFOUND_MASK (0x01 << 16)
140#define TEA5777_R_SFOUND_SHIFT 16
141#define TEA5777_R_BLIM_MASK (0x01 << 15)
142#define TEA5777_R_BLIM_SHIFT 15
143
144/* Read reg, FM specific bits */
145#define TEA5777_R_FM_STEREO_MASK (0x01 << 21)
146#define TEA5777_R_FM_STEREO_SHIFT 21
147#define TEA5777_R_FM_PLL_MASK 0x1fff
148#define TEA5777_R_FM_PLL_SHIFT 0
149
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300150enum { BAND_FM, BAND_AM };
151
152static const struct v4l2_frequency_band bands[] = {
153 {
154 .type = V4L2_TUNER_RADIO,
155 .index = 0,
156 .capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
157 V4L2_TUNER_CAP_FREQ_BANDS |
158 V4L2_TUNER_CAP_HWSEEK_BOUNDED |
159 V4L2_TUNER_CAP_HWSEEK_PROG_LIM,
160 .rangelow = 76000 * 16,
161 .rangehigh = 108000 * 16,
162 .modulation = V4L2_BAND_MODULATION_FM,
163 },
164 {
165 .type = V4L2_TUNER_RADIO,
166 .index = 1,
167 .capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_FREQ_BANDS |
168 V4L2_TUNER_CAP_HWSEEK_BOUNDED |
169 V4L2_TUNER_CAP_HWSEEK_PROG_LIM,
170 .rangelow = 530 * 16,
171 .rangehigh = 1710 * 16,
172 .modulation = V4L2_BAND_MODULATION_AM,
173 },
174};
175
Hans de Goede4faba762012-06-23 04:39:58 -0300176static u32 tea5777_freq_to_v4l2_freq(struct radio_tea5777 *tea, u32 freq)
177{
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300178 switch (tea->band) {
179 case BAND_FM:
180 return (freq * TEA5777_FM_FREQ_STEP + TEA5777_FM_IF) * 16;
181 case BAND_AM:
182 return (freq * TEA5777_AM_FREQ_STEP + TEA5777_AM_IF) * 16;
183 }
184 return 0; /* Never reached */
Hans de Goede4faba762012-06-23 04:39:58 -0300185}
186
Hans de Goeded1f280d2012-08-11 12:37:13 -0300187int radio_tea5777_set_freq(struct radio_tea5777 *tea)
Hans de Goede4faba762012-06-23 04:39:58 -0300188{
Hans de Goede4fad5c42012-08-10 07:47:25 -0300189 u32 freq;
Hans de Goede4faba762012-06-23 04:39:58 -0300190 int res;
191
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300192 freq = clamp(tea->freq, bands[tea->band].rangelow,
193 bands[tea->band].rangehigh);
Hans de Goede4fad5c42012-08-10 07:47:25 -0300194 freq = (freq + 8) / 16; /* to kHz */
Hans de Goede4faba762012-06-23 04:39:58 -0300195
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300196 switch (tea->band) {
197 case BAND_FM:
198 tea->write_reg &= ~TEA5777_W_AM_FM_MASK;
199 freq = (freq - TEA5777_FM_IF) / TEA5777_FM_FREQ_STEP;
200 tea->write_reg &= ~TEA5777_W_FM_PLL_MASK;
201 tea->write_reg |= (u64)freq << TEA5777_W_FM_PLL_SHIFT;
202 tea->write_reg &= ~TEA5777_W_FM_FREF_MASK;
203 tea->write_reg |= TEA5777_W_FM_FREF_VALUE <<
204 TEA5777_W_FM_FREF_SHIFT;
205 tea->write_reg &= ~TEA5777_W_FM_FORCEMONO_MASK;
206 if (tea->audmode == V4L2_TUNER_MODE_MONO)
207 tea->write_reg |= 1LL << TEA5777_W_FM_FORCEMONO_SHIFT;
208 break;
209 case BAND_AM:
210 tea->write_reg &= ~TEA5777_W_AM_FM_MASK;
211 tea->write_reg |= (1LL << TEA5777_W_AM_FM_SHIFT);
212 freq = (freq - TEA5777_AM_IF) / TEA5777_AM_FREQ_STEP;
213 tea->write_reg &= ~TEA5777_W_AM_PLL_MASK;
214 tea->write_reg |= (u64)freq << TEA5777_W_AM_PLL_SHIFT;
215 tea->write_reg &= ~TEA5777_W_AM_AGCRF_MASK;
216 tea->write_reg &= ~TEA5777_W_AM_AGCRF_MASK;
217 tea->write_reg &= ~TEA5777_W_AM_MWLW_MASK;
218 tea->write_reg |= TEA5777_W_AM_MW << TEA5777_W_AM_MWLW_SHIFT;
219 tea->write_reg &= ~TEA5777_W_AM_LNA_MASK;
220 tea->write_reg |= 1LL << TEA5777_W_AM_LNA_SHIFT;
221 tea->write_reg &= ~TEA5777_W_AM_PEAK_MASK;
222 tea->write_reg |= 1LL << TEA5777_W_AM_PEAK_SHIFT;
223 tea->write_reg &= ~TEA5777_W_AM_CALLIGN_MASK;
224 break;
225 }
Hans de Goede4faba762012-06-23 04:39:58 -0300226
227 res = tea->ops->write_reg(tea, tea->write_reg);
228 if (res)
229 return res;
230
231 tea->needs_write = false;
232 tea->read_reg = -1;
233 tea->freq = tea5777_freq_to_v4l2_freq(tea, freq);
234
235 return 0;
236}
237
238static int radio_tea5777_update_read_reg(struct radio_tea5777 *tea, int wait)
239{
240 int res;
241
242 if (tea->read_reg != -1)
243 return 0;
244
245 if (tea->write_before_read && tea->needs_write) {
246 res = radio_tea5777_set_freq(tea);
247 if (res)
248 return res;
249 }
250
251 if (wait) {
252 if (schedule_timeout_interruptible(msecs_to_jiffies(wait)))
253 return -ERESTARTSYS;
254 }
255
256 res = tea->ops->read_reg(tea, &tea->read_reg);
257 if (res)
258 return res;
259
260 tea->needs_write = true;
261 return 0;
262}
263
264/*
265 * Linux Video interface
266 */
267
268static int vidioc_querycap(struct file *file, void *priv,
269 struct v4l2_capability *v)
270{
271 struct radio_tea5777 *tea = video_drvdata(file);
272
273 strlcpy(v->driver, tea->v4l2_dev->name, sizeof(v->driver));
274 strlcpy(v->card, tea->card, sizeof(v->card));
275 strlcat(v->card, " TEA5777", sizeof(v->card));
276 strlcpy(v->bus_info, tea->bus_info, sizeof(v->bus_info));
277 v->device_caps = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
278 v->device_caps |= V4L2_CAP_HW_FREQ_SEEK;
279 v->capabilities = v->device_caps | V4L2_CAP_DEVICE_CAPS;
280 return 0;
281}
282
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300283static int vidioc_enum_freq_bands(struct file *file, void *priv,
284 struct v4l2_frequency_band *band)
285{
286 struct radio_tea5777 *tea = video_drvdata(file);
287
288 if (band->tuner != 0 || band->index >= ARRAY_SIZE(bands) ||
289 (!tea->has_am && band->index == BAND_AM))
290 return -EINVAL;
291
292 *band = bands[band->index];
293 return 0;
294}
295
Hans de Goede4faba762012-06-23 04:39:58 -0300296static int vidioc_g_tuner(struct file *file, void *priv,
297 struct v4l2_tuner *v)
298{
299 struct radio_tea5777 *tea = video_drvdata(file);
300 int res;
301
302 if (v->index > 0)
303 return -EINVAL;
304
305 res = radio_tea5777_update_read_reg(tea, 0);
306 if (res)
307 return res;
308
309 memset(v, 0, sizeof(*v));
310 if (tea->has_am)
311 strlcpy(v->name, "AM/FM", sizeof(v->name));
312 else
313 strlcpy(v->name, "FM", sizeof(v->name));
314 v->type = V4L2_TUNER_RADIO;
315 v->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300316 V4L2_TUNER_CAP_FREQ_BANDS |
317 V4L2_TUNER_CAP_HWSEEK_BOUNDED |
318 V4L2_TUNER_CAP_HWSEEK_PROG_LIM;
319 v->rangelow = tea->has_am ? bands[BAND_AM].rangelow :
320 bands[BAND_FM].rangelow;
321 v->rangehigh = bands[BAND_FM].rangehigh;
322 if (tea->band == BAND_FM &&
323 (tea->read_reg & TEA5777_R_FM_STEREO_MASK))
324 v->rxsubchans = V4L2_TUNER_SUB_STEREO;
325 else
326 v->rxsubchans = V4L2_TUNER_SUB_MONO;
327 v->audmode = tea->audmode;
Hans de Goede4faba762012-06-23 04:39:58 -0300328 /* shift - 12 to convert 4-bits (0-15) scale to 16-bits (0-65535) */
329 v->signal = (tea->read_reg & TEA5777_R_LEVEL_MASK) >>
330 (TEA5777_R_LEVEL_SHIFT - 12);
331
332 /* Invalidate read_reg, so that next call we return up2date signal */
333 tea->read_reg = -1;
334
335 return 0;
336}
337
338static int vidioc_s_tuner(struct file *file, void *priv,
Hans Verkuil2f73c7c2013-03-15 06:10:06 -0300339 const struct v4l2_tuner *v)
Hans de Goede4faba762012-06-23 04:39:58 -0300340{
341 struct radio_tea5777 *tea = video_drvdata(file);
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300342 u32 orig_audmode = tea->audmode;
Hans de Goede4faba762012-06-23 04:39:58 -0300343
344 if (v->index)
345 return -EINVAL;
346
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300347 tea->audmode = v->audmode;
Hans Verkuil2f73c7c2013-03-15 06:10:06 -0300348 if (tea->audmode > V4L2_TUNER_MODE_STEREO)
349 tea->audmode = V4L2_TUNER_MODE_STEREO;
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300350
351 if (tea->audmode != orig_audmode && tea->band == BAND_FM)
352 return radio_tea5777_set_freq(tea);
353
354 return 0;
Hans de Goede4faba762012-06-23 04:39:58 -0300355}
356
357static int vidioc_g_frequency(struct file *file, void *priv,
358 struct v4l2_frequency *f)
359{
360 struct radio_tea5777 *tea = video_drvdata(file);
361
362 if (f->tuner != 0)
363 return -EINVAL;
364 f->type = V4L2_TUNER_RADIO;
365 f->frequency = tea->freq;
366 return 0;
367}
368
369static int vidioc_s_frequency(struct file *file, void *priv,
Hans Verkuilb530a442013-03-19 04:09:26 -0300370 const struct v4l2_frequency *f)
Hans de Goede4faba762012-06-23 04:39:58 -0300371{
372 struct radio_tea5777 *tea = video_drvdata(file);
373
374 if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
375 return -EINVAL;
376
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300377 if (tea->has_am && f->frequency < (20000 * 16))
378 tea->band = BAND_AM;
379 else
380 tea->band = BAND_FM;
381
Hans de Goede4faba762012-06-23 04:39:58 -0300382 tea->freq = f->frequency;
383 return radio_tea5777_set_freq(tea);
384}
385
386static int vidioc_s_hw_freq_seek(struct file *file, void *fh,
Hans Verkuilec6f4322012-09-14 07:41:18 -0300387 const struct v4l2_hw_freq_seek *a)
Hans de Goede4faba762012-06-23 04:39:58 -0300388{
389 struct radio_tea5777 *tea = video_drvdata(file);
Hans de Goede4faba762012-06-23 04:39:58 -0300390 unsigned long timeout;
Hans Verkuilec6f4322012-09-14 07:41:18 -0300391 u32 rangelow = a->rangelow;
392 u32 rangehigh = a->rangehigh;
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300393 int i, res, spacing;
394 u32 orig_freq;
Hans de Goede4faba762012-06-23 04:39:58 -0300395
396 if (a->tuner || a->wrap_around)
397 return -EINVAL;
398
Hans Verkuil617ade62012-09-21 09:33:35 -0300399 if (file->f_flags & O_NONBLOCK)
400 return -EWOULDBLOCK;
401
Hans Verkuilec6f4322012-09-14 07:41:18 -0300402 if (rangelow || rangehigh) {
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300403 for (i = 0; i < ARRAY_SIZE(bands); i++) {
404 if (i == BAND_AM && !tea->has_am)
405 continue;
Hans Verkuilec6f4322012-09-14 07:41:18 -0300406 if (bands[i].rangelow >= rangelow &&
407 bands[i].rangehigh <= rangehigh)
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300408 break;
409 }
410 if (i == ARRAY_SIZE(bands))
411 return -EINVAL; /* No matching band found */
412
413 tea->band = i;
Hans Verkuilec6f4322012-09-14 07:41:18 -0300414 if (tea->freq < rangelow || tea->freq > rangehigh) {
415 tea->freq = clamp(tea->freq, rangelow,
416 rangehigh);
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300417 res = radio_tea5777_set_freq(tea);
418 if (res)
419 return res;
420 }
421 } else {
Hans Verkuilec6f4322012-09-14 07:41:18 -0300422 rangelow = bands[tea->band].rangelow;
423 rangehigh = bands[tea->band].rangehigh;
Hans de Goede4faba762012-06-23 04:39:58 -0300424 }
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300425
426 spacing = (tea->band == BAND_AM) ? (5 * 16) : (200 * 16); /* kHz */
427 orig_freq = tea->freq;
428
429 tea->write_reg |= TEA5777_W_PROGBLIM_MASK;
Hans Verkuilec6f4322012-09-14 07:41:18 -0300430 if (tea->seek_rangelow != rangelow) {
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300431 tea->write_reg &= ~TEA5777_W_UPDWN_MASK;
Hans Verkuilec6f4322012-09-14 07:41:18 -0300432 tea->freq = rangelow;
Hans de Goede4faba762012-06-23 04:39:58 -0300433 res = radio_tea5777_set_freq(tea);
434 if (res)
435 goto leave;
Hans Verkuilec6f4322012-09-14 07:41:18 -0300436 tea->seek_rangelow = rangelow;
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300437 }
Hans Verkuilec6f4322012-09-14 07:41:18 -0300438 if (tea->seek_rangehigh != rangehigh) {
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300439 tea->write_reg |= TEA5777_W_UPDWN_MASK;
Hans Verkuilec6f4322012-09-14 07:41:18 -0300440 tea->freq = rangehigh;
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300441 res = radio_tea5777_set_freq(tea);
442 if (res)
443 goto leave;
Hans Verkuilec6f4322012-09-14 07:41:18 -0300444 tea->seek_rangehigh = rangehigh;
Hans de Goede4faba762012-06-23 04:39:58 -0300445 }
446 tea->write_reg &= ~TEA5777_W_PROGBLIM_MASK;
447
448 tea->write_reg |= TEA5777_W_SEARCH_MASK;
449 if (a->seek_upward) {
450 tea->write_reg |= TEA5777_W_UPDWN_MASK;
451 tea->freq = orig_freq + spacing;
452 } else {
453 tea->write_reg &= ~TEA5777_W_UPDWN_MASK;
454 tea->freq = orig_freq - spacing;
455 }
456 res = radio_tea5777_set_freq(tea);
457 if (res)
458 goto leave;
459
460 timeout = jiffies + msecs_to_jiffies(5000);
461 for (;;) {
462 if (time_after(jiffies, timeout)) {
463 res = -ENODATA;
464 break;
465 }
466
467 res = radio_tea5777_update_read_reg(tea, 100);
468 if (res)
469 break;
470
471 /*
472 * Note we use tea->freq to track how far we've searched sofar
473 * this is necessary to ensure we continue seeking at the right
474 * point, in the write_before_read case.
475 */
476 tea->freq = (tea->read_reg & TEA5777_R_FM_PLL_MASK);
477 tea->freq = tea5777_freq_to_v4l2_freq(tea, tea->freq);
478
479 if ((tea->read_reg & TEA5777_R_SFOUND_MASK)) {
480 tea->write_reg &= ~TEA5777_W_SEARCH_MASK;
481 return 0;
482 }
483
484 if (tea->read_reg & TEA5777_R_BLIM_MASK) {
485 res = -ENODATA;
486 break;
487 }
488
489 /* Force read_reg update */
490 tea->read_reg = -1;
491 }
492leave:
493 tea->write_reg &= ~TEA5777_W_PROGBLIM_MASK;
494 tea->write_reg &= ~TEA5777_W_SEARCH_MASK;
495 tea->freq = orig_freq;
496 radio_tea5777_set_freq(tea);
497 return res;
498}
499
500static int tea575x_s_ctrl(struct v4l2_ctrl *c)
501{
502 struct radio_tea5777 *tea =
503 container_of(c->handler, struct radio_tea5777, ctrl_handler);
504
505 switch (c->id) {
506 case V4L2_CID_AUDIO_MUTE:
507 if (c->val)
508 tea->write_reg |= TEA5777_W_MUTE_MASK;
509 else
510 tea->write_reg &= ~TEA5777_W_MUTE_MASK;
511
512 return radio_tea5777_set_freq(tea);
513 }
514
515 return -EINVAL;
516}
517
518static const struct v4l2_file_operations tea575x_fops = {
519 .unlocked_ioctl = video_ioctl2,
520 .open = v4l2_fh_open,
521 .release = v4l2_fh_release,
522 .poll = v4l2_ctrl_poll,
523};
524
525static const struct v4l2_ioctl_ops tea575x_ioctl_ops = {
526 .vidioc_querycap = vidioc_querycap,
527 .vidioc_g_tuner = vidioc_g_tuner,
528 .vidioc_s_tuner = vidioc_s_tuner,
529 .vidioc_g_frequency = vidioc_g_frequency,
530 .vidioc_s_frequency = vidioc_s_frequency,
531 .vidioc_s_hw_freq_seek = vidioc_s_hw_freq_seek,
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300532 .vidioc_enum_freq_bands = vidioc_enum_freq_bands,
Hans de Goede4faba762012-06-23 04:39:58 -0300533 .vidioc_log_status = v4l2_ctrl_log_status,
534 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
535 .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
536};
537
538static const struct video_device tea575x_radio = {
539 .ioctl_ops = &tea575x_ioctl_ops,
540 .release = video_device_release_empty,
541};
542
543static const struct v4l2_ctrl_ops tea575x_ctrl_ops = {
544 .s_ctrl = tea575x_s_ctrl,
545};
546
547int radio_tea5777_init(struct radio_tea5777 *tea, struct module *owner)
548{
549 int res;
550
551 tea->write_reg = (1LL << TEA5777_W_IFCE_SHIFT) |
552 (1LL << TEA5777_W_IFW_SHIFT) |
553 (1LL << TEA5777_W_INTEXT_SHIFT) |
554 (1LL << TEA5777_W_CHP0_SHIFT) |
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300555 (1LL << TEA5777_W_SLEV_SHIFT);
Hans de Goede4faba762012-06-23 04:39:58 -0300556 tea->freq = 90500 * 16; /* 90.5Mhz default */
Hans de Goeded7aab0b2012-08-10 15:49:59 -0300557 tea->audmode = V4L2_TUNER_MODE_STEREO;
Hans de Goede4faba762012-06-23 04:39:58 -0300558 res = radio_tea5777_set_freq(tea);
559 if (res) {
560 v4l2_err(tea->v4l2_dev, "can't set initial freq (%d)\n", res);
561 return res;
562 }
563
564 tea->vd = tea575x_radio;
565 video_set_drvdata(&tea->vd, tea);
566 mutex_init(&tea->mutex);
567 strlcpy(tea->vd.name, tea->v4l2_dev->name, sizeof(tea->vd.name));
568 tea->vd.lock = &tea->mutex;
569 tea->vd.v4l2_dev = tea->v4l2_dev;
570 tea->fops = tea575x_fops;
571 tea->fops.owner = owner;
572 tea->vd.fops = &tea->fops;
Hans de Goede4faba762012-06-23 04:39:58 -0300573
574 tea->vd.ctrl_handler = &tea->ctrl_handler;
575 v4l2_ctrl_handler_init(&tea->ctrl_handler, 1);
576 v4l2_ctrl_new_std(&tea->ctrl_handler, &tea575x_ctrl_ops,
577 V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
578 res = tea->ctrl_handler.error;
579 if (res) {
580 v4l2_err(tea->v4l2_dev, "can't initialize controls\n");
581 v4l2_ctrl_handler_free(&tea->ctrl_handler);
582 return res;
583 }
584 v4l2_ctrl_handler_setup(&tea->ctrl_handler);
585
586 res = video_register_device(&tea->vd, VFL_TYPE_RADIO, -1);
587 if (res) {
588 v4l2_err(tea->v4l2_dev, "can't register video device!\n");
589 v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
590 return res;
591 }
592
593 return 0;
594}
595EXPORT_SYMBOL_GPL(radio_tea5777_init);
596
597void radio_tea5777_exit(struct radio_tea5777 *tea)
598{
599 video_unregister_device(&tea->vd);
600 v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
601}
602EXPORT_SYMBOL_GPL(radio_tea5777_exit);