^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * ALSA driver for TEA5757/5759 Philips AM/FM radio tuner chips
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (c) 2004 Jaroslav Kysela <perex@perex.cz>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/sched.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <media/v4l2-device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <media/v4l2-dev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <media/v4l2-fh.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <media/v4l2-ioctl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <media/v4l2-event.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <media/drv-intf/tea575x.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) MODULE_DESCRIPTION("Routines for control of TEA5757/5759 Philips AM/FM radio tuner chips");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) * definitions
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define TEA575X_BIT_SEARCH (1<<24) /* 1 = search action, 0 = tuned */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define TEA575X_BIT_UPDOWN (1<<23) /* 0 = search down, 1 = search up */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define TEA575X_BIT_MONO (1<<22) /* 0 = stereo, 1 = mono */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define TEA575X_BIT_BAND_MASK (3<<20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define TEA575X_BIT_BAND_FM (0<<20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define TEA575X_BIT_BAND_MW (1<<20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define TEA575X_BIT_BAND_LW (2<<20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define TEA575X_BIT_BAND_SW (3<<20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define TEA575X_BIT_PORT_0 (1<<19) /* user bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define TEA575X_BIT_PORT_1 (1<<18) /* user bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define TEA575X_BIT_SEARCH_MASK (3<<16) /* search level */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define TEA575X_BIT_SEARCH_5_28 (0<<16) /* FM >5uV, AM >28uV */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define TEA575X_BIT_SEARCH_10_40 (1<<16) /* FM >10uV, AM > 40uV */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define TEA575X_BIT_SEARCH_30_63 (2<<16) /* FM >30uV, AM > 63uV */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define TEA575X_BIT_SEARCH_150_1000 (3<<16) /* FM > 150uV, AM > 1000uV */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define TEA575X_BIT_DUMMY (1<<15) /* buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define TEA575X_BIT_FREQ_MASK 0x7fff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) enum { BAND_FM, BAND_FM_JAPAN, BAND_AM };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) static const struct v4l2_frequency_band bands[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) .type = V4L2_TUNER_RADIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) .index = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) .capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) V4L2_TUNER_CAP_FREQ_BANDS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) .rangelow = 87500 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) .rangehigh = 108000 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) .modulation = V4L2_BAND_MODULATION_FM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) .type = V4L2_TUNER_RADIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) .index = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) .capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) V4L2_TUNER_CAP_FREQ_BANDS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) .rangelow = 76000 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) .rangehigh = 91000 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) .modulation = V4L2_BAND_MODULATION_FM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) .type = V4L2_TUNER_RADIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) .index = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) .capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_FREQ_BANDS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) .rangelow = 530 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) .rangehigh = 1710 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) .modulation = V4L2_BAND_MODULATION_AM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) * lowlevel part
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) static void snd_tea575x_write(struct snd_tea575x *tea, unsigned int val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) u16 l;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) u8 data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) if (tea->ops->write_val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) return tea->ops->write_val(tea, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) tea->ops->set_direction(tea, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) udelay(16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) for (l = 25; l > 0; l--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) data = (val >> 24) & TEA575X_DATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) val <<= 1; /* shift data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) tea->ops->set_pins(tea, data | TEA575X_WREN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) udelay(2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) tea->ops->set_pins(tea, data | TEA575X_WREN | TEA575X_CLK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) udelay(2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) tea->ops->set_pins(tea, data | TEA575X_WREN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) udelay(2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) if (!tea->mute)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) tea->ops->set_pins(tea, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static u32 snd_tea575x_read(struct snd_tea575x *tea)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) u16 l, rdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) u32 data = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) if (tea->ops->read_val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) return tea->ops->read_val(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) tea->ops->set_direction(tea, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) tea->ops->set_pins(tea, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) udelay(16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) for (l = 24; l--;) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) tea->ops->set_pins(tea, TEA575X_CLK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) udelay(2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) if (!l)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) tea->tuned = tea->ops->get_pins(tea) & TEA575X_MOST ? 0 : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) tea->ops->set_pins(tea, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) udelay(2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) data <<= 1; /* shift data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) rdata = tea->ops->get_pins(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) if (!l)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) tea->stereo = (rdata & TEA575X_MOST) ? 0 : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) if (rdata & TEA575X_DATA)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) data++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) udelay(2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) if (tea->mute)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) tea->ops->set_pins(tea, TEA575X_WREN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) return data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) static u32 snd_tea575x_val_to_freq(struct snd_tea575x *tea, u32 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) u32 freq = val & TEA575X_BIT_FREQ_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) if (freq == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) return freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) switch (tea->band) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) case BAND_FM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) /* freq *= 12.5 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) freq *= 125;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) freq /= 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) /* crystal fixup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) freq -= TEA575X_FMIF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) case BAND_FM_JAPAN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) /* freq *= 12.5 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) freq *= 125;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) freq /= 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) /* crystal fixup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) freq += TEA575X_FMIF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) case BAND_AM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) /* crystal fixup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) freq -= TEA575X_AMIF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) return clamp(freq * 16, bands[tea->band].rangelow,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) bands[tea->band].rangehigh); /* from kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) static u32 snd_tea575x_get_freq(struct snd_tea575x *tea)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) return snd_tea575x_val_to_freq(tea, snd_tea575x_read(tea));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) void snd_tea575x_set_freq(struct snd_tea575x *tea)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) u32 freq = tea->freq / 16; /* to kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) u32 band = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) switch (tea->band) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) case BAND_FM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) band = TEA575X_BIT_BAND_FM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) /* crystal fixup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) freq += TEA575X_FMIF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) /* freq /= 12.5 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) freq *= 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) freq /= 125;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) case BAND_FM_JAPAN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) band = TEA575X_BIT_BAND_FM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) /* crystal fixup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) freq -= TEA575X_FMIF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) /* freq /= 12.5 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) freq *= 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) freq /= 125;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) case BAND_AM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) band = TEA575X_BIT_BAND_MW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) /* crystal fixup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) freq += TEA575X_AMIF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) tea->val &= ~(TEA575X_BIT_FREQ_MASK | TEA575X_BIT_BAND_MASK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) tea->val |= band;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) tea->val |= freq & TEA575X_BIT_FREQ_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) snd_tea575x_write(tea, tea->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) tea->freq = snd_tea575x_val_to_freq(tea, tea->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) EXPORT_SYMBOL(snd_tea575x_set_freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) * Linux Video interface
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) static int vidioc_querycap(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) struct v4l2_capability *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) struct snd_tea575x *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) strscpy(v->driver, tea->v4l2_dev->name, sizeof(v->driver));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) strscpy(v->card, tea->card, sizeof(v->card));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) strlcat(v->card, tea->tea5759 ? " TEA5759" : " TEA5757", sizeof(v->card));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) strscpy(v->bus_info, tea->bus_info, sizeof(v->bus_info));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) int snd_tea575x_enum_freq_bands(struct snd_tea575x *tea,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) struct v4l2_frequency_band *band)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) int index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) if (band->tuner != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) switch (band->index) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) case 0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) if (tea->tea5759)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) index = BAND_FM_JAPAN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) index = BAND_FM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) if (tea->has_am) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) index = BAND_AM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) *band = bands[index];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) if (!tea->cannot_read_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) band->capability |= V4L2_TUNER_CAP_HWSEEK_BOUNDED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) EXPORT_SYMBOL(snd_tea575x_enum_freq_bands);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) static int vidioc_enum_freq_bands(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) struct v4l2_frequency_band *band)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) struct snd_tea575x *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) return snd_tea575x_enum_freq_bands(tea, band);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) int snd_tea575x_g_tuner(struct snd_tea575x *tea, struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) struct v4l2_frequency_band band_fm = { 0, };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) if (v->index > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) snd_tea575x_read(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) snd_tea575x_enum_freq_bands(tea, &band_fm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) memset(v, 0, sizeof(*v));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) strscpy(v->name, tea->has_am ? "FM/AM" : "FM", sizeof(v->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) v->type = V4L2_TUNER_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) v->capability = band_fm.capability;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) v->rangelow = tea->has_am ? bands[BAND_AM].rangelow : band_fm.rangelow;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) v->rangehigh = band_fm.rangehigh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) v->rxsubchans = tea->stereo ? V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) v->audmode = (tea->val & TEA575X_BIT_MONO) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) V4L2_TUNER_MODE_MONO : V4L2_TUNER_MODE_STEREO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) v->signal = tea->tuned ? 0xffff : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) EXPORT_SYMBOL(snd_tea575x_g_tuner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) static int vidioc_g_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) struct snd_tea575x *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) return snd_tea575x_g_tuner(tea, v);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) static int vidioc_s_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) const struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) struct snd_tea575x *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) u32 orig_val = tea->val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) if (v->index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) tea->val &= ~TEA575X_BIT_MONO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) if (v->audmode == V4L2_TUNER_MODE_MONO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) tea->val |= TEA575X_BIT_MONO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) /* Only apply changes if currently tuning FM */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) if (tea->band != BAND_AM && tea->val != orig_val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) snd_tea575x_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) static int vidioc_g_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) struct snd_tea575x *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) if (f->tuner != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) f->type = V4L2_TUNER_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) f->frequency = tea->freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) static int vidioc_s_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) const struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) struct snd_tea575x *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) if (tea->has_am && f->frequency < (20000 * 16))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) tea->band = BAND_AM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) else if (tea->tea5759)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) tea->band = BAND_FM_JAPAN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) tea->band = BAND_FM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) tea->freq = clamp_t(u32, f->frequency, bands[tea->band].rangelow,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) bands[tea->band].rangehigh);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) snd_tea575x_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) int snd_tea575x_s_hw_freq_seek(struct file *file, struct snd_tea575x *tea,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) const struct v4l2_hw_freq_seek *a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) unsigned long timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) int i, spacing;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) if (tea->cannot_read_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) return -ENOTTY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) if (a->tuner || a->wrap_around)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) if (file->f_flags & O_NONBLOCK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) return -EWOULDBLOCK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) if (a->rangelow || a->rangehigh) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) for (i = 0; i < ARRAY_SIZE(bands); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) if ((i == BAND_FM && tea->tea5759) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) (i == BAND_FM_JAPAN && !tea->tea5759) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) (i == BAND_AM && !tea->has_am))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) if (bands[i].rangelow == a->rangelow &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) bands[i].rangehigh == a->rangehigh)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) if (i == ARRAY_SIZE(bands))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) return -EINVAL; /* No matching band found */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) if (i != tea->band) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) tea->band = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) tea->freq = clamp(tea->freq, bands[i].rangelow,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) bands[i].rangehigh);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) snd_tea575x_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) spacing = (tea->band == BAND_AM) ? 5 : 50; /* kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) /* clear the frequency, HW will fill it in */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) tea->val &= ~TEA575X_BIT_FREQ_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) tea->val |= TEA575X_BIT_SEARCH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) if (a->seek_upward)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) tea->val |= TEA575X_BIT_UPDOWN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) tea->val &= ~TEA575X_BIT_UPDOWN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) snd_tea575x_write(tea, tea->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) timeout = jiffies + msecs_to_jiffies(10000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) for (;;) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) if (time_after(jiffies, timeout))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) if (schedule_timeout_interruptible(msecs_to_jiffies(10))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) /* some signal arrived, stop search */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) tea->val &= ~TEA575X_BIT_SEARCH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) snd_tea575x_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) return -ERESTARTSYS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) if (!(snd_tea575x_read(tea) & TEA575X_BIT_SEARCH)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) u32 freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) /* Found a frequency, wait until it can be read */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) for (i = 0; i < 100; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) msleep(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) freq = snd_tea575x_get_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) if (freq) /* available */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) if (freq == 0) /* shouldn't happen */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) * if we moved by less than the spacing, or in the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) * wrong direction, continue seeking
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) if (abs(tea->freq - freq) < 16 * spacing ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) (a->seek_upward && freq < tea->freq) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) (!a->seek_upward && freq > tea->freq)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) snd_tea575x_write(tea, tea->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) tea->freq = freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) tea->val &= ~TEA575X_BIT_SEARCH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) tea->val &= ~TEA575X_BIT_SEARCH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) snd_tea575x_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) return -ENODATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) EXPORT_SYMBOL(snd_tea575x_s_hw_freq_seek);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) static int vidioc_s_hw_freq_seek(struct file *file, void *fh,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) const struct v4l2_hw_freq_seek *a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) struct snd_tea575x *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) return snd_tea575x_s_hw_freq_seek(file, tea, a);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) static int tea575x_s_ctrl(struct v4l2_ctrl *ctrl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) struct snd_tea575x *tea = container_of(ctrl->handler, struct snd_tea575x, ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) switch (ctrl->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) case V4L2_CID_AUDIO_MUTE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) tea->mute = ctrl->val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) snd_tea575x_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) static const struct v4l2_file_operations tea575x_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) .unlocked_ioctl = video_ioctl2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) .open = v4l2_fh_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) .release = v4l2_fh_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) .poll = v4l2_ctrl_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) static const struct v4l2_ioctl_ops tea575x_ioctl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) .vidioc_querycap = vidioc_querycap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) .vidioc_g_tuner = vidioc_g_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) .vidioc_s_tuner = vidioc_s_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) .vidioc_g_frequency = vidioc_g_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) .vidioc_s_frequency = vidioc_s_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) .vidioc_s_hw_freq_seek = vidioc_s_hw_freq_seek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) .vidioc_enum_freq_bands = vidioc_enum_freq_bands,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) .vidioc_log_status = v4l2_ctrl_log_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) static const struct video_device tea575x_radio = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) .ioctl_ops = &tea575x_ioctl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) .release = video_device_release_empty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) static const struct v4l2_ctrl_ops tea575x_ctrl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) .s_ctrl = tea575x_s_ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) int snd_tea575x_hw_init(struct snd_tea575x *tea)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) tea->mute = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) /* Not all devices can or know how to read the data back.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) Such devices can set cannot_read_data to true. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) if (!tea->cannot_read_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) snd_tea575x_write(tea, 0x55AA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) if (snd_tea575x_read(tea) != 0x55AA)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) tea->val = TEA575X_BIT_BAND_FM | TEA575X_BIT_SEARCH_5_28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) tea->freq = 90500 * 16; /* 90.5Mhz default */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) snd_tea575x_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) EXPORT_SYMBOL(snd_tea575x_hw_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) int snd_tea575x_init(struct snd_tea575x *tea, struct module *owner)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) int retval = snd_tea575x_hw_init(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) tea->vd = tea575x_radio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) video_set_drvdata(&tea->vd, tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) mutex_init(&tea->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) strscpy(tea->vd.name, tea->v4l2_dev->name, sizeof(tea->vd.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) tea->vd.lock = &tea->mutex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) tea->vd.v4l2_dev = tea->v4l2_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) tea->vd.device_caps = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) if (!tea->cannot_read_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) tea->vd.device_caps |= V4L2_CAP_HW_FREQ_SEEK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) tea->fops = tea575x_fops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) tea->fops.owner = owner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) tea->vd.fops = &tea->fops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) /* disable hw_freq_seek if we can't use it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) if (tea->cannot_read_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) v4l2_disable_ioctl(&tea->vd, VIDIOC_S_HW_FREQ_SEEK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) if (!tea->cannot_mute) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) tea->vd.ctrl_handler = &tea->ctrl_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) v4l2_ctrl_handler_init(&tea->ctrl_handler, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) v4l2_ctrl_new_std(&tea->ctrl_handler, &tea575x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) retval = tea->ctrl_handler.error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) if (retval) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) v4l2_err(tea->v4l2_dev, "can't initialize controls\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) v4l2_ctrl_handler_free(&tea->ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) if (tea->ext_init) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) retval = tea->ext_init(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) if (retval) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) v4l2_ctrl_handler_free(&tea->ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) v4l2_ctrl_handler_setup(&tea->ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) retval = video_register_device(&tea->vd, VFL_TYPE_RADIO, tea->radio_nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) if (retval) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) v4l2_err(tea->v4l2_dev, "can't register video device!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) EXPORT_SYMBOL(snd_tea575x_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) void snd_tea575x_exit(struct snd_tea575x *tea)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) video_unregister_device(&tea->vd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) EXPORT_SYMBOL(snd_tea575x_exit);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags