^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) * v4l2 driver for TEA5777 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) 2012 Hans de Goede <hdegoede@redhat.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Based on the ALSA driver for TEA5757/5759 Philips AM/FM radio tuner chips:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * Copyright (c) 2004 Jaroslav Kysela <perex@perex.cz>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/sched.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <media/v4l2-device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <media/v4l2-dev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <media/v4l2-fh.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <media/v4l2-ioctl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <media/v4l2-event.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include "radio-tea5777.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) MODULE_AUTHOR("Hans de Goede <perex@perex.cz>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) MODULE_DESCRIPTION("Routines for control of TEA5777 Philips AM/FM radio tuner chips");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define TEA5777_FM_IF 150 /* kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define TEA5777_FM_FREQ_STEP 50 /* kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define TEA5777_AM_IF 21 /* kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define TEA5777_AM_FREQ_STEP 1 /* kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) /* Write reg, common bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define TEA5777_W_MUTE_MASK (1LL << 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define TEA5777_W_MUTE_SHIFT 47
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define TEA5777_W_AM_FM_MASK (1LL << 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define TEA5777_W_AM_FM_SHIFT 46
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define TEA5777_W_STB_MASK (1LL << 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define TEA5777_W_STB_SHIFT 45
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define TEA5777_W_IFCE_MASK (1LL << 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define TEA5777_W_IFCE_SHIFT 29
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define TEA5777_W_IFW_MASK (1LL << 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define TEA5777_W_IFW_SHIFT 28
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define TEA5777_W_HILO_MASK (1LL << 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define TEA5777_W_HILO_SHIFT 27
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) #define TEA5777_W_DBUS_MASK (1LL << 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #define TEA5777_W_DBUS_SHIFT 26
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #define TEA5777_W_INTEXT_MASK (1LL << 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define TEA5777_W_INTEXT_SHIFT 24
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) #define TEA5777_W_P1_MASK (1LL << 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) #define TEA5777_W_P1_SHIFT 23
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) #define TEA5777_W_P0_MASK (1LL << 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) #define TEA5777_W_P0_SHIFT 22
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) #define TEA5777_W_PEN1_MASK (1LL << 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) #define TEA5777_W_PEN1_SHIFT 21
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) #define TEA5777_W_PEN0_MASK (1LL << 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) #define TEA5777_W_PEN0_SHIFT 20
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) #define TEA5777_W_CHP0_MASK (1LL << 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) #define TEA5777_W_CHP0_SHIFT 18
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) #define TEA5777_W_DEEM_MASK (1LL << 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) #define TEA5777_W_DEEM_SHIFT 17
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) #define TEA5777_W_SEARCH_MASK (1LL << 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) #define TEA5777_W_SEARCH_SHIFT 7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) #define TEA5777_W_PROGBLIM_MASK (1LL << 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) #define TEA5777_W_PROGBLIM_SHIFT 6
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) #define TEA5777_W_UPDWN_MASK (1LL << 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) #define TEA5777_W_UPDWN_SHIFT 5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) #define TEA5777_W_SLEV_MASK (3LL << 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) #define TEA5777_W_SLEV_SHIFT 3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) /* Write reg, FM specific bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) #define TEA5777_W_FM_PLL_MASK (0x1fffLL << 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) #define TEA5777_W_FM_PLL_SHIFT 32
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) #define TEA5777_W_FM_FREF_MASK (0x03LL << 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) #define TEA5777_W_FM_FREF_SHIFT 30
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) #define TEA5777_W_FM_FREF_VALUE 0LL /* 50k steps, 150k IF */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) #define TEA5777_W_FM_FORCEMONO_MASK (1LL << 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) #define TEA5777_W_FM_FORCEMONO_SHIFT 15
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) #define TEA5777_W_FM_SDSOFF_MASK (1LL << 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) #define TEA5777_W_FM_SDSOFF_SHIFT 14
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) #define TEA5777_W_FM_DOFF_MASK (1LL << 13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) #define TEA5777_W_FM_DOFF_SHIFT 13
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) #define TEA5777_W_FM_STEP_MASK (3LL << 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) #define TEA5777_W_FM_STEP_SHIFT 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) /* Write reg, AM specific bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) #define TEA5777_W_AM_PLL_MASK (0x7ffLL << 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) #define TEA5777_W_AM_PLL_SHIFT 34
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) #define TEA5777_W_AM_AGCRF_MASK (1LL << 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) #define TEA5777_W_AM_AGCRF_SHIFT 33
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) #define TEA5777_W_AM_AGCIF_MASK (1LL << 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) #define TEA5777_W_AM_AGCIF_SHIFT 32
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) #define TEA5777_W_AM_MWLW_MASK (1LL << 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) #define TEA5777_W_AM_MWLW_SHIFT 31
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) #define TEA5777_W_AM_LW 0LL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) #define TEA5777_W_AM_MW 1LL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) #define TEA5777_W_AM_LNA_MASK (1LL << 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) #define TEA5777_W_AM_LNA_SHIFT 30
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) #define TEA5777_W_AM_PEAK_MASK (1LL << 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) #define TEA5777_W_AM_PEAK_SHIFT 25
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) #define TEA5777_W_AM_RFB_MASK (1LL << 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) #define TEA5777_W_AM_RFB_SHIFT 16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) #define TEA5777_W_AM_CALLIGN_MASK (1LL << 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) #define TEA5777_W_AM_CALLIGN_SHIFT 15
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) #define TEA5777_W_AM_CBANK_MASK (0x7fLL << 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) #define TEA5777_W_AM_CBANK_SHIFT 8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) #define TEA5777_W_AM_DELAY_MASK (1LL << 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) #define TEA5777_W_AM_DELAY_SHIFT 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) #define TEA5777_W_AM_STEP_MASK (1LL << 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) #define TEA5777_W_AM_STEP_SHIFT 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) /* Read reg, common bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) #define TEA5777_R_LEVEL_MASK (0x0f << 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) #define TEA5777_R_LEVEL_SHIFT 17
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) #define TEA5777_R_SFOUND_MASK (0x01 << 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) #define TEA5777_R_SFOUND_SHIFT 16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) #define TEA5777_R_BLIM_MASK (0x01 << 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) #define TEA5777_R_BLIM_SHIFT 15
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) /* Read reg, FM specific bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) #define TEA5777_R_FM_STEREO_MASK (0x01 << 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) #define TEA5777_R_FM_STEREO_SHIFT 21
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) #define TEA5777_R_FM_PLL_MASK 0x1fff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) #define TEA5777_R_FM_PLL_SHIFT 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) enum { BAND_FM, BAND_AM };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) static const struct v4l2_frequency_band bands[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) .type = V4L2_TUNER_RADIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) .index = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) .capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) V4L2_TUNER_CAP_FREQ_BANDS |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) V4L2_TUNER_CAP_HWSEEK_BOUNDED |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) V4L2_TUNER_CAP_HWSEEK_PROG_LIM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) .rangelow = 76000 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) .rangehigh = 108000 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) .modulation = V4L2_BAND_MODULATION_FM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) .type = V4L2_TUNER_RADIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) .index = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) .capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_FREQ_BANDS |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) V4L2_TUNER_CAP_HWSEEK_BOUNDED |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) V4L2_TUNER_CAP_HWSEEK_PROG_LIM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) .rangelow = 530 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) .rangehigh = 1710 * 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) .modulation = V4L2_BAND_MODULATION_AM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) static u32 tea5777_freq_to_v4l2_freq(struct radio_tea5777 *tea, u32 freq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) switch (tea->band) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) case BAND_FM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) return (freq * TEA5777_FM_FREQ_STEP + TEA5777_FM_IF) * 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) case BAND_AM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) return (freq * TEA5777_AM_FREQ_STEP + TEA5777_AM_IF) * 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) return 0; /* Never reached */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) int radio_tea5777_set_freq(struct radio_tea5777 *tea)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) u32 freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) int res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) freq = clamp(tea->freq, bands[tea->band].rangelow,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) bands[tea->band].rangehigh);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) freq = (freq + 8) / 16; /* to kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) switch (tea->band) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) case BAND_FM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) tea->write_reg &= ~TEA5777_W_AM_FM_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) freq = (freq - TEA5777_FM_IF) / TEA5777_FM_FREQ_STEP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) tea->write_reg &= ~TEA5777_W_FM_PLL_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) tea->write_reg |= (u64)freq << TEA5777_W_FM_PLL_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) tea->write_reg &= ~TEA5777_W_FM_FREF_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) tea->write_reg |= TEA5777_W_FM_FREF_VALUE <<
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) TEA5777_W_FM_FREF_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) tea->write_reg &= ~TEA5777_W_FM_FORCEMONO_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) if (tea->audmode == V4L2_TUNER_MODE_MONO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) tea->write_reg |= 1LL << TEA5777_W_FM_FORCEMONO_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) case BAND_AM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) tea->write_reg &= ~TEA5777_W_AM_FM_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) tea->write_reg |= (1LL << TEA5777_W_AM_FM_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) freq = (freq - TEA5777_AM_IF) / TEA5777_AM_FREQ_STEP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) tea->write_reg &= ~TEA5777_W_AM_PLL_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) tea->write_reg |= (u64)freq << TEA5777_W_AM_PLL_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) tea->write_reg &= ~TEA5777_W_AM_AGCRF_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) tea->write_reg &= ~TEA5777_W_AM_AGCRF_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) tea->write_reg &= ~TEA5777_W_AM_MWLW_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) tea->write_reg |= TEA5777_W_AM_MW << TEA5777_W_AM_MWLW_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) tea->write_reg &= ~TEA5777_W_AM_LNA_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) tea->write_reg |= 1LL << TEA5777_W_AM_LNA_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) tea->write_reg &= ~TEA5777_W_AM_PEAK_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) tea->write_reg |= 1LL << TEA5777_W_AM_PEAK_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) tea->write_reg &= ~TEA5777_W_AM_CALLIGN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) res = tea->ops->write_reg(tea, tea->write_reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) tea->needs_write = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) tea->read_reg = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) tea->freq = tea5777_freq_to_v4l2_freq(tea, freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) static int radio_tea5777_update_read_reg(struct radio_tea5777 *tea, int wait)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) int res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) if (tea->read_reg != -1)
^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) if (tea->write_before_read && tea->needs_write) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) res = radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) if (wait) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) if (schedule_timeout_interruptible(msecs_to_jiffies(wait)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) return -ERESTARTSYS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) res = tea->ops->read_reg(tea, &tea->read_reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) tea->needs_write = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) * Linux Video interface
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) static int vidioc_querycap(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) struct v4l2_capability *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) struct radio_tea5777 *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) strscpy(v->driver, tea->v4l2_dev->name, sizeof(v->driver));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) strscpy(v->card, tea->card, sizeof(v->card));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) strlcat(v->card, " TEA5777", sizeof(v->card));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) strscpy(v->bus_info, tea->bus_info, sizeof(v->bus_info));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) static int vidioc_enum_freq_bands(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) struct v4l2_frequency_band *band)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) struct radio_tea5777 *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) if (band->tuner != 0 || band->index >= ARRAY_SIZE(bands) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) (!tea->has_am && band->index == BAND_AM))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) *band = bands[band->index];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) static int vidioc_g_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) struct radio_tea5777 *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) int res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) if (v->index > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) res = radio_tea5777_update_read_reg(tea, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) memset(v, 0, sizeof(*v));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) if (tea->has_am)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) strscpy(v->name, "AM/FM", sizeof(v->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) strscpy(v->name, "FM", sizeof(v->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) v->type = V4L2_TUNER_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) v->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) V4L2_TUNER_CAP_FREQ_BANDS |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) V4L2_TUNER_CAP_HWSEEK_BOUNDED |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) V4L2_TUNER_CAP_HWSEEK_PROG_LIM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) v->rangelow = tea->has_am ? bands[BAND_AM].rangelow :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) bands[BAND_FM].rangelow;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) v->rangehigh = bands[BAND_FM].rangehigh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) if (tea->band == BAND_FM &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) (tea->read_reg & TEA5777_R_FM_STEREO_MASK))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) v->rxsubchans = V4L2_TUNER_SUB_STEREO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) v->rxsubchans = V4L2_TUNER_SUB_MONO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) v->audmode = tea->audmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) /* shift - 12 to convert 4-bits (0-15) scale to 16-bits (0-65535) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) v->signal = (tea->read_reg & TEA5777_R_LEVEL_MASK) >>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) (TEA5777_R_LEVEL_SHIFT - 12);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) /* Invalidate read_reg, so that next call we return up2date signal */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) tea->read_reg = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) static int vidioc_s_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) const struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) struct radio_tea5777 *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) u32 orig_audmode = tea->audmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) if (v->index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) tea->audmode = v->audmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) if (tea->audmode > V4L2_TUNER_MODE_STEREO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) tea->audmode = V4L2_TUNER_MODE_STEREO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) if (tea->audmode != orig_audmode && tea->band == BAND_FM)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) return radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) static int vidioc_g_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) struct radio_tea5777 *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) if (f->tuner != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) f->type = V4L2_TUNER_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) f->frequency = tea->freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) static int vidioc_s_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) const struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) struct radio_tea5777 *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) if (tea->has_am && f->frequency < (20000 * 16))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) tea->band = BAND_AM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) tea->band = BAND_FM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) tea->freq = f->frequency;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) return radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) static int vidioc_s_hw_freq_seek(struct file *file, void *fh,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) const struct v4l2_hw_freq_seek *a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) struct radio_tea5777 *tea = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) unsigned long timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) u32 rangelow = a->rangelow;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) u32 rangehigh = a->rangehigh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) int i, res, spacing;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) u32 orig_freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) if (a->tuner || a->wrap_around)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) if (file->f_flags & O_NONBLOCK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) return -EWOULDBLOCK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) if (rangelow || rangehigh) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) for (i = 0; i < ARRAY_SIZE(bands); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) if (i == BAND_AM && !tea->has_am)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) if (bands[i].rangelow >= rangelow &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) bands[i].rangehigh <= rangehigh)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) if (i == ARRAY_SIZE(bands))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) return -EINVAL; /* No matching band found */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) tea->band = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) if (tea->freq < rangelow || tea->freq > rangehigh) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) tea->freq = clamp(tea->freq, rangelow,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) rangehigh);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) res = radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) rangelow = bands[tea->band].rangelow;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) rangehigh = bands[tea->band].rangehigh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) spacing = (tea->band == BAND_AM) ? (5 * 16) : (200 * 16); /* kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) orig_freq = tea->freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) tea->write_reg |= TEA5777_W_PROGBLIM_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) if (tea->seek_rangelow != rangelow) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) tea->write_reg &= ~TEA5777_W_UPDWN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) tea->freq = rangelow;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) res = radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) goto leave;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) tea->seek_rangelow = rangelow;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) if (tea->seek_rangehigh != rangehigh) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) tea->write_reg |= TEA5777_W_UPDWN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) tea->freq = rangehigh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) res = radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) goto leave;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) tea->seek_rangehigh = rangehigh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) tea->write_reg &= ~TEA5777_W_PROGBLIM_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) tea->write_reg |= TEA5777_W_SEARCH_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) if (a->seek_upward) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) tea->write_reg |= TEA5777_W_UPDWN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) tea->freq = orig_freq + spacing;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) tea->write_reg &= ~TEA5777_W_UPDWN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) tea->freq = orig_freq - spacing;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) res = radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) goto leave;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) timeout = jiffies + msecs_to_jiffies(5000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) for (;;) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) if (time_after(jiffies, timeout)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) res = -ENODATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) res = radio_tea5777_update_read_reg(tea, 100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) * Note we use tea->freq to track how far we've searched sofar
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) * this is necessary to ensure we continue seeking at the right
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) * point, in the write_before_read case.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) tea->freq = (tea->read_reg & TEA5777_R_FM_PLL_MASK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) tea->freq = tea5777_freq_to_v4l2_freq(tea, tea->freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) if ((tea->read_reg & TEA5777_R_SFOUND_MASK)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) tea->write_reg &= ~TEA5777_W_SEARCH_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) if (tea->read_reg & TEA5777_R_BLIM_MASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) res = -ENODATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) break;
^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) /* Force read_reg update */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) tea->read_reg = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) leave:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) tea->write_reg &= ~TEA5777_W_PROGBLIM_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) tea->write_reg &= ~TEA5777_W_SEARCH_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) tea->freq = orig_freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) static int tea575x_s_ctrl(struct v4l2_ctrl *c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) struct radio_tea5777 *tea =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) container_of(c->handler, struct radio_tea5777, ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) switch (c->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) case V4L2_CID_AUDIO_MUTE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) if (c->val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) tea->write_reg |= TEA5777_W_MUTE_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) tea->write_reg &= ~TEA5777_W_MUTE_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) return radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) static const struct v4l2_file_operations tea575x_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) .unlocked_ioctl = video_ioctl2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) .open = v4l2_fh_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) .release = v4l2_fh_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) .poll = v4l2_ctrl_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) static const struct v4l2_ioctl_ops tea575x_ioctl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) .vidioc_querycap = vidioc_querycap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) .vidioc_g_tuner = vidioc_g_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) .vidioc_s_tuner = vidioc_s_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) .vidioc_g_frequency = vidioc_g_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) .vidioc_s_frequency = vidioc_s_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) .vidioc_s_hw_freq_seek = vidioc_s_hw_freq_seek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) .vidioc_enum_freq_bands = vidioc_enum_freq_bands,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) .vidioc_log_status = v4l2_ctrl_log_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) static const struct video_device tea575x_radio = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) .ioctl_ops = &tea575x_ioctl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) .release = video_device_release_empty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) static const struct v4l2_ctrl_ops tea575x_ctrl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) .s_ctrl = tea575x_s_ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) int radio_tea5777_init(struct radio_tea5777 *tea, struct module *owner)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) int res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) tea->write_reg = (1LL << TEA5777_W_IFCE_SHIFT) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) (1LL << TEA5777_W_IFW_SHIFT) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) (1LL << TEA5777_W_INTEXT_SHIFT) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) (1LL << TEA5777_W_CHP0_SHIFT) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) (1LL << TEA5777_W_SLEV_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) tea->freq = 90500 * 16; /* 90.5Mhz default */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) tea->audmode = V4L2_TUNER_MODE_STEREO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) res = radio_tea5777_set_freq(tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) if (res) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) v4l2_err(tea->v4l2_dev, "can't set initial freq (%d)\n", res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) tea->vd = tea575x_radio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) video_set_drvdata(&tea->vd, tea);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) mutex_init(&tea->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) strscpy(tea->vd.name, tea->v4l2_dev->name, sizeof(tea->vd.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) tea->vd.lock = &tea->mutex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) tea->vd.v4l2_dev = tea->v4l2_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) tea->vd.device_caps = V4L2_CAP_TUNER | V4L2_CAP_RADIO |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) V4L2_CAP_HW_FREQ_SEEK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) tea->fops = tea575x_fops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) tea->fops.owner = owner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) tea->vd.fops = &tea->fops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) tea->vd.ctrl_handler = &tea->ctrl_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) v4l2_ctrl_handler_init(&tea->ctrl_handler, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) v4l2_ctrl_new_std(&tea->ctrl_handler, &tea575x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) res = tea->ctrl_handler.error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) if (res) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) v4l2_err(tea->v4l2_dev, "can't initialize controls\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) v4l2_ctrl_handler_free(&tea->ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) v4l2_ctrl_handler_setup(&tea->ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) res = video_register_device(&tea->vd, VFL_TYPE_RADIO, -1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) if (res) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) v4l2_err(tea->v4l2_dev, "can't register video device!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) EXPORT_SYMBOL_GPL(radio_tea5777_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) void radio_tea5777_exit(struct radio_tea5777 *tea)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) video_unregister_device(&tea->vd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) EXPORT_SYMBOL_GPL(radio_tea5777_exit);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags