^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * drivers/media/radio/radio-si476x.c -- V4L2 driver for SI476X chips
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2012 Innovative Converged Devices(ICD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright (C) 2013 Andrey Smirnov
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * Author: Andrey Smirnov <andrew.smirnov@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/module.h>
^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/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/atomic.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/videodev2.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/debugfs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <media/v4l2-common.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-ctrls.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <media/v4l2-event.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <media/v4l2-device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <media/drv-intf/si476x.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <linux/mfd/si476x-core.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define FM_FREQ_RANGE_LOW 64000000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define FM_FREQ_RANGE_HIGH 108000000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define AM_FREQ_RANGE_LOW 520000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define AM_FREQ_RANGE_HIGH 30000000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define PWRLINEFLTR (1 << 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define FREQ_MUL (10000000 / 625)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define SI476X_PHDIV_STATUS_LINK_LOCKED(status) (0x80 & (status))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define DRIVER_NAME "si476x-radio"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define DRIVER_CARD "SI476x AM/FM Receiver"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) enum si476x_freq_bands {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) SI476X_BAND_FM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) SI476X_BAND_AM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) static const struct v4l2_frequency_band si476x_bands[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) [SI476X_BAND_FM] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) .type = V4L2_TUNER_RADIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) .index = SI476X_BAND_FM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) .capability = V4L2_TUNER_CAP_LOW
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) | V4L2_TUNER_CAP_STEREO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) | V4L2_TUNER_CAP_RDS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) | V4L2_TUNER_CAP_RDS_BLOCK_IO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) | V4L2_TUNER_CAP_FREQ_BANDS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) .rangelow = 64 * FREQ_MUL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) .rangehigh = 108 * FREQ_MUL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) .modulation = V4L2_BAND_MODULATION_FM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) [SI476X_BAND_AM] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) .type = V4L2_TUNER_RADIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) .index = SI476X_BAND_AM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) .capability = V4L2_TUNER_CAP_LOW
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) | V4L2_TUNER_CAP_FREQ_BANDS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) .rangelow = 0.52 * FREQ_MUL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) .rangehigh = 30 * FREQ_MUL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) .modulation = V4L2_BAND_MODULATION_AM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) static inline bool si476x_radio_freq_is_inside_of_the_band(u32 freq, int band)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) return freq >= si476x_bands[band].rangelow &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) freq <= si476x_bands[band].rangehigh;
^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) static inline bool si476x_radio_range_is_inside_of_the_band(u32 low, u32 high,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) int band)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) return low >= si476x_bands[band].rangelow &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) high <= si476x_bands[band].rangehigh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) static int si476x_radio_s_ctrl(struct v4l2_ctrl *ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) static int si476x_radio_g_volatile_ctrl(struct v4l2_ctrl *ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) enum phase_diversity_modes_idx {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) SI476X_IDX_PHDIV_DISABLED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) SI476X_IDX_PHDIV_PRIMARY_COMBINING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) SI476X_IDX_PHDIV_PRIMARY_ANTENNA,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) SI476X_IDX_PHDIV_SECONDARY_ANTENNA,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) SI476X_IDX_PHDIV_SECONDARY_COMBINING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) static const char * const phase_diversity_modes[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) [SI476X_IDX_PHDIV_DISABLED] = "Disabled",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) [SI476X_IDX_PHDIV_PRIMARY_COMBINING] = "Primary with Secondary",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) [SI476X_IDX_PHDIV_PRIMARY_ANTENNA] = "Primary Antenna",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) [SI476X_IDX_PHDIV_SECONDARY_ANTENNA] = "Secondary Antenna",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) [SI476X_IDX_PHDIV_SECONDARY_COMBINING] = "Secondary with Primary",
^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) static inline enum phase_diversity_modes_idx
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) si476x_phase_diversity_mode_to_idx(enum si476x_phase_diversity_mode mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) switch (mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) case SI476X_PHDIV_DISABLED:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) return SI476X_IDX_PHDIV_DISABLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) case SI476X_PHDIV_PRIMARY_COMBINING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) return SI476X_IDX_PHDIV_PRIMARY_COMBINING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) case SI476X_PHDIV_PRIMARY_ANTENNA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) return SI476X_IDX_PHDIV_PRIMARY_ANTENNA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) case SI476X_PHDIV_SECONDARY_ANTENNA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) return SI476X_IDX_PHDIV_SECONDARY_ANTENNA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) case SI476X_PHDIV_SECONDARY_COMBINING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) return SI476X_IDX_PHDIV_SECONDARY_COMBINING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) static inline enum si476x_phase_diversity_mode
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) si476x_phase_diversity_idx_to_mode(enum phase_diversity_modes_idx idx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) static const int idx_to_value[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) [SI476X_IDX_PHDIV_DISABLED] = SI476X_PHDIV_DISABLED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) [SI476X_IDX_PHDIV_PRIMARY_COMBINING] = SI476X_PHDIV_PRIMARY_COMBINING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) [SI476X_IDX_PHDIV_PRIMARY_ANTENNA] = SI476X_PHDIV_PRIMARY_ANTENNA,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) [SI476X_IDX_PHDIV_SECONDARY_ANTENNA] = SI476X_PHDIV_SECONDARY_ANTENNA,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) [SI476X_IDX_PHDIV_SECONDARY_COMBINING] = SI476X_PHDIV_SECONDARY_COMBINING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) return idx_to_value[idx];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) static const struct v4l2_ctrl_ops si476x_ctrl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) .g_volatile_ctrl = si476x_radio_g_volatile_ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) .s_ctrl = si476x_radio_s_ctrl,
^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)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) enum si476x_ctrl_idx {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) SI476X_IDX_RSSI_THRESHOLD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) SI476X_IDX_SNR_THRESHOLD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) SI476X_IDX_MAX_TUNE_ERROR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) SI476X_IDX_HARMONICS_COUNT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) SI476X_IDX_DIVERSITY_MODE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) SI476X_IDX_INTERCHIP_LINK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) static struct v4l2_ctrl_config si476x_ctrls[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) * SI476X during its station seeking(or tuning) process uses several
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) * parameters to detrmine if "the station" is valid:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) * - Signal's SNR(in dBuV) must be lower than
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) * #V4L2_CID_SI476X_SNR_THRESHOLD
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) * - Signal's RSSI(in dBuV) must be greater than
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) * #V4L2_CID_SI476X_RSSI_THRESHOLD
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) * - Signal's frequency deviation(in units of 2ppm) must not be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) * more than #V4L2_CID_SI476X_MAX_TUNE_ERROR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) [SI476X_IDX_RSSI_THRESHOLD] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) .ops = &si476x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) .id = V4L2_CID_SI476X_RSSI_THRESHOLD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) .name = "Valid RSSI Threshold",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) .type = V4L2_CTRL_TYPE_INTEGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) .min = -128,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) .max = 127,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) .step = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) [SI476X_IDX_SNR_THRESHOLD] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) .ops = &si476x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) .id = V4L2_CID_SI476X_SNR_THRESHOLD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) .type = V4L2_CTRL_TYPE_INTEGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) .name = "Valid SNR Threshold",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) .min = -128,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) .max = 127,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) .step = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) [SI476X_IDX_MAX_TUNE_ERROR] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) .ops = &si476x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) .id = V4L2_CID_SI476X_MAX_TUNE_ERROR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) .type = V4L2_CTRL_TYPE_INTEGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) .name = "Max Tune Errors",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) .min = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) .max = 126 * 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) .step = 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) * #V4L2_CID_SI476X_HARMONICS_COUNT -- number of harmonics
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) * built-in power-line noise supression filter is to reject
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) * during AM-mode operation.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) [SI476X_IDX_HARMONICS_COUNT] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) .ops = &si476x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) .id = V4L2_CID_SI476X_HARMONICS_COUNT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) .type = V4L2_CTRL_TYPE_INTEGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) .name = "Count of Harmonics to Reject",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) .min = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) .max = 20,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) .step = 1,
^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) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) * #V4L2_CID_SI476X_DIVERSITY_MODE -- configuration which
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) * two tuners working in diversity mode are to work in.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) * - #SI476X_IDX_PHDIV_DISABLED diversity mode disabled
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) * - #SI476X_IDX_PHDIV_PRIMARY_COMBINING diversity mode is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) * on, primary tuner's antenna is the main one.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) * - #SI476X_IDX_PHDIV_PRIMARY_ANTENNA diversity mode is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) * off, primary tuner's antenna is the main one.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) * - #SI476X_IDX_PHDIV_SECONDARY_ANTENNA diversity mode is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) * off, secondary tuner's antenna is the main one.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) * - #SI476X_IDX_PHDIV_SECONDARY_COMBINING diversity mode is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) * on, secondary tuner's antenna is the main one.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) [SI476X_IDX_DIVERSITY_MODE] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) .ops = &si476x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) .id = V4L2_CID_SI476X_DIVERSITY_MODE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) .type = V4L2_CTRL_TYPE_MENU,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) .name = "Phase Diversity Mode",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) .qmenu = phase_diversity_modes,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) .min = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) .max = ARRAY_SIZE(phase_diversity_modes) - 1,
^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) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) * #V4L2_CID_SI476X_INTERCHIP_LINK -- inter-chip link in
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) * diversity mode indicator. Allows user to determine if two
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) * chips working in diversity mode have established a link
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) * between each other and if the system as a whole uses
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) * signals from both antennas to receive FM radio.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) [SI476X_IDX_INTERCHIP_LINK] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) .ops = &si476x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) .id = V4L2_CID_SI476X_INTERCHIP_LINK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) .type = V4L2_CTRL_TYPE_BOOLEAN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) .flags = V4L2_CTRL_FLAG_READ_ONLY | V4L2_CTRL_FLAG_VOLATILE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) .name = "Inter-Chip Link",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) .min = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) .max = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) .step = 1,
^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) struct si476x_radio;
^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) * struct si476x_radio_ops - vtable of tuner functions
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) * This table holds pointers to functions implementing particular
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) * operations depending on the mode in which the tuner chip was
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) * configured to start in. If the function is not supported
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) * corresponding element is set to #NULL.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) * @tune_freq: Tune chip to a specific frequency
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) * @seek_start: Star station seeking
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) * @rsq_status: Get Received Signal Quality(RSQ) status
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) * @rds_blckcnt: Get received RDS blocks count
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) * @phase_diversity: Change phase diversity mode of the tuner
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) * @phase_div_status: Get phase diversity mode status
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) * @acf_status: Get the status of Automatically Controlled
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) * Features(ACF)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) * @agc_status: Get Automatic Gain Control(AGC) status
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) struct si476x_radio_ops {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) int (*tune_freq)(struct si476x_core *, struct si476x_tune_freq_args *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) int (*seek_start)(struct si476x_core *, bool, bool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) int (*rsq_status)(struct si476x_core *, struct si476x_rsq_status_args *,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) struct si476x_rsq_status_report *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) int (*rds_blckcnt)(struct si476x_core *, bool,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) struct si476x_rds_blockcount_report *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) int (*phase_diversity)(struct si476x_core *,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) enum si476x_phase_diversity_mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) int (*phase_div_status)(struct si476x_core *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) int (*acf_status)(struct si476x_core *,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) struct si476x_acf_status_report *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) int (*agc_status)(struct si476x_core *,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) struct si476x_agc_status_report *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) * struct si476x_radio - radio device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) * @v4l2dev: Pointer to V4L2 device created by V4L2 subsystem
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) * @videodev: Pointer to video device created by V4L2 subsystem
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) * @ctrl_handler: V4L2 controls handler
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) * @core: Pointer to underlying core device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) * @ops: Vtable of functions. See struct si476x_radio_ops for details
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) * @debugfs: pointer to &strucd dentry for debugfs
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) * @audmode: audio mode, as defined for the rxsubchans field
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) * at videodev2.h
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) * core structure is the radio device is being used
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) struct si476x_radio {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) struct v4l2_device v4l2dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) struct video_device videodev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) struct v4l2_ctrl_handler ctrl_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) struct si476x_core *core;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) /* This field should not be accesses unless core lock is held */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) const struct si476x_radio_ops *ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) struct dentry *debugfs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) u32 audmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) static inline struct si476x_radio *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) v4l2_dev_to_radio(struct v4l2_device *d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) return container_of(d, struct si476x_radio, v4l2dev);
^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 inline struct si476x_radio *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) v4l2_ctrl_handler_to_radio(struct v4l2_ctrl_handler *d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) return container_of(d, struct si476x_radio, ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) * si476x_vidioc_querycap - query device capabilities
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) static int si476x_radio_querycap(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) struct v4l2_capability *capability)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) strscpy(capability->driver, radio->v4l2dev.name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) sizeof(capability->driver));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) strscpy(capability->card, DRIVER_CARD, sizeof(capability->card));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) snprintf(capability->bus_info, sizeof(capability->bus_info),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) "platform:%s", radio->v4l2dev.name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) static int si476x_radio_enum_freq_bands(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) struct v4l2_frequency_band *band)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) if (band->tuner != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) switch (radio->core->chip_id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) /* AM/FM tuners -- all bands are supported */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) case SI476X_CHIP_SI4761:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) case SI476X_CHIP_SI4764:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) if (band->index < ARRAY_SIZE(si476x_bands)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) *band = si476x_bands[band->index];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) /* FM companion tuner chips -- only FM bands are
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) * supported */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) case SI476X_CHIP_SI4768:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) if (band->index == SI476X_BAND_FM) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) *band = si476x_bands[band->index];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) static int si476x_radio_g_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) struct v4l2_tuner *tuner)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) struct si476x_rsq_status_report report;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) struct si476x_rsq_status_args args = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) .primary = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) .rsqack = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) .attune = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) .cancel = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) .stcack = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) if (tuner->index != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) tuner->type = V4L2_TUNER_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) tuner->capability = V4L2_TUNER_CAP_LOW /* Measure frequencies
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) * in multiples of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) * 62.5 Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) | V4L2_TUNER_CAP_STEREO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) | V4L2_TUNER_CAP_HWSEEK_BOUNDED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) | V4L2_TUNER_CAP_HWSEEK_WRAP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) | V4L2_TUNER_CAP_HWSEEK_PROG_LIM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) if (si476x_core_is_a_secondary_tuner(radio->core)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) strscpy(tuner->name, "FM (secondary)", sizeof(tuner->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) tuner->rxsubchans = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) tuner->rangelow = si476x_bands[SI476X_BAND_FM].rangelow;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) } else if (si476x_core_has_am(radio->core)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) if (si476x_core_is_a_primary_tuner(radio->core))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) strscpy(tuner->name, "AM/FM (primary)",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) sizeof(tuner->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) strscpy(tuner->name, "AM/FM", sizeof(tuner->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) tuner->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) | V4L2_TUNER_SUB_RDS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) tuner->capability |= V4L2_TUNER_CAP_RDS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) | V4L2_TUNER_CAP_RDS_BLOCK_IO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) | V4L2_TUNER_CAP_FREQ_BANDS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) tuner->rangelow = si476x_bands[SI476X_BAND_AM].rangelow;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) strscpy(tuner->name, "FM", sizeof(tuner->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) tuner->rxsubchans = V4L2_TUNER_SUB_RDS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) tuner->capability |= V4L2_TUNER_CAP_RDS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) | V4L2_TUNER_CAP_RDS_BLOCK_IO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) | V4L2_TUNER_CAP_FREQ_BANDS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) tuner->rangelow = si476x_bands[SI476X_BAND_FM].rangelow;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) tuner->audmode = radio->audmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) tuner->afc = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) tuner->rangehigh = si476x_bands[SI476X_BAND_FM].rangehigh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) err = radio->ops->rsq_status(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) &args, &report);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) tuner->signal = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) * tuner->signal value range: 0x0000 .. 0xFFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) * report.rssi: -128 .. 127
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) tuner->signal = (report.rssi + 128) * 257;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) static int si476x_radio_s_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) const struct v4l2_tuner *tuner)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) if (tuner->index != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) if (tuner->audmode == V4L2_TUNER_MODE_MONO ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) tuner->audmode == V4L2_TUNER_MODE_STEREO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) radio->audmode = tuner->audmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) radio->audmode = V4L2_TUNER_MODE_STEREO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) static int si476x_radio_init_vtable(struct si476x_radio *radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) enum si476x_func func)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) static const struct si476x_radio_ops fm_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) .tune_freq = si476x_core_cmd_fm_tune_freq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) .seek_start = si476x_core_cmd_fm_seek_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) .rsq_status = si476x_core_cmd_fm_rsq_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) .rds_blckcnt = si476x_core_cmd_fm_rds_blockcount,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) .phase_diversity = si476x_core_cmd_fm_phase_diversity,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) .phase_div_status = si476x_core_cmd_fm_phase_div_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) .acf_status = si476x_core_cmd_fm_acf_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) .agc_status = si476x_core_cmd_agc_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) static const struct si476x_radio_ops am_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) .tune_freq = si476x_core_cmd_am_tune_freq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) .seek_start = si476x_core_cmd_am_seek_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) .rsq_status = si476x_core_cmd_am_rsq_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) .rds_blckcnt = NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) .phase_diversity = NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) .phase_div_status = NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) .acf_status = si476x_core_cmd_am_acf_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) .agc_status = NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) switch (func) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) case SI476X_FUNC_FM_RECEIVER:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) radio->ops = &fm_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) case SI476X_FUNC_AM_RECEIVER:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) radio->ops = &am_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) WARN(1, "Unexpected tuner function value\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) static int si476x_radio_pretune(struct si476x_radio *radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) enum si476x_func func)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) struct si476x_tune_freq_args args = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) .zifsr = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) .hd = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) .injside = SI476X_INJSIDE_AUTO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) .tunemode = SI476X_TM_VALIDATED_NORMAL_TUNE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) .smoothmetrics = SI476X_SM_INITIALIZE_AUDIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) .antcap = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) switch (func) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) case SI476X_FUNC_FM_RECEIVER:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) args.freq = v4l2_to_si476x(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) 92 * FREQ_MUL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) retval = radio->ops->tune_freq(radio->core, &args);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) case SI476X_FUNC_AM_RECEIVER:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) args.freq = v4l2_to_si476x(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) 0.6 * FREQ_MUL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) retval = radio->ops->tune_freq(radio->core, &args);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) WARN(1, "Unexpected tuner function value\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) retval = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) static int si476x_radio_do_post_powerup_init(struct si476x_radio *radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) enum si476x_func func)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) /* regcache_mark_dirty(radio->core->regmap); */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) err = regcache_sync_region(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) SI476X_PROP_DIGITAL_IO_INPUT_SAMPLE_RATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) SI476X_PROP_DIGITAL_IO_OUTPUT_FORMAT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) err = regcache_sync_region(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) SI476X_PROP_AUDIO_DEEMPHASIS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) SI476X_PROP_AUDIO_PWR_LINE_FILTER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) err = regcache_sync_region(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) SI476X_PROP_INT_CTL_ENABLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) SI476X_PROP_INT_CTL_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) * Is there any point in restoring SNR and the like
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) * when switching between AM/FM?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) err = regcache_sync_region(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) SI476X_PROP_VALID_MAX_TUNE_ERROR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) SI476X_PROP_VALID_MAX_TUNE_ERROR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) err = regcache_sync_region(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) SI476X_PROP_VALID_SNR_THRESHOLD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) SI476X_PROP_VALID_RSSI_THRESHOLD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) if (func == SI476X_FUNC_FM_RECEIVER) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) if (si476x_core_has_diversity(radio->core)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) err = si476x_core_cmd_fm_phase_diversity(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) radio->core->diversity_mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) err = regcache_sync_region(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) SI476X_PROP_FM_RDS_INTERRUPT_SOURCE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) SI476X_PROP_FM_RDS_CONFIG);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) return si476x_radio_init_vtable(radio, func);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) static int si476x_radio_change_func(struct si476x_radio *radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) enum si476x_func func)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) bool soft;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) * Since power/up down is a very time consuming operation,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) * try to avoid doing it if the requested mode matches the one
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) * the tuner is in
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) if (func == radio->core->power_up_parameters.func)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) soft = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) err = si476x_core_stop(radio->core, soft);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) * OK, if the chip does not want to play nice let's
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) * try to reset it in more brutal way
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) soft = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) err = si476x_core_stop(radio->core, soft);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) Set the desired radio tuner function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) radio->core->power_up_parameters.func = func;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) err = si476x_core_start(radio->core, soft);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) * No need to do the rest of manipulations for the bootlader
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) * mode
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) if (func != SI476X_FUNC_FM_RECEIVER &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) func != SI476X_FUNC_AM_RECEIVER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) return si476x_radio_do_post_powerup_init(radio, func);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) static int si476x_radio_g_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) if (f->tuner != 0 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) f->type != V4L2_TUNER_RADIO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) if (radio->ops->rsq_status) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) struct si476x_rsq_status_report report;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) struct si476x_rsq_status_args args = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) .primary = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) .rsqack = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) .attune = true,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) .cancel = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) .stcack = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) err = radio->ops->rsq_status(radio->core, &args, &report);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) if (!err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) f->frequency = si476x_to_v4l2(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) report.readfreq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) static int si476x_radio_s_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) const struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) u32 freq = f->frequency;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) struct si476x_tune_freq_args args;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) const u32 midrange = (si476x_bands[SI476X_BAND_AM].rangehigh +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) si476x_bands[SI476X_BAND_FM].rangelow) / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) const int band = (freq > midrange) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) SI476X_BAND_FM : SI476X_BAND_AM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) const enum si476x_func func = (band == SI476X_BAND_AM) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) SI476X_FUNC_AM_RECEIVER : SI476X_FUNC_FM_RECEIVER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) if (f->tuner != 0 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) f->type != V4L2_TUNER_RADIO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) freq = clamp(freq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) si476x_bands[band].rangelow,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) si476x_bands[band].rangehigh);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) if (si476x_radio_freq_is_inside_of_the_band(freq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) SI476X_BAND_AM) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) (!si476x_core_has_am(radio->core) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) si476x_core_is_a_secondary_tuner(radio->core))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) err = si476x_radio_change_func(radio, func);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) args.zifsr = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) args.hd = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) args.injside = SI476X_INJSIDE_AUTO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) args.freq = v4l2_to_si476x(radio->core, freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) args.tunemode = SI476X_TM_VALIDATED_NORMAL_TUNE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) args.smoothmetrics = SI476X_SM_INITIALIZE_AUDIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) args.antcap = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) err = radio->ops->tune_freq(radio->core, &args);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) unlock:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) static int si476x_radio_s_hw_freq_seek(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) const struct v4l2_hw_freq_seek *seek)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) enum si476x_func func;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) u32 rangelow = seek->rangelow, rangehigh = seek->rangehigh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) if (file->f_flags & O_NONBLOCK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) if (seek->tuner != 0 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) seek->type != V4L2_TUNER_RADIO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) if (!rangelow) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) err = regmap_read(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) SI476X_PROP_SEEK_BAND_BOTTOM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) &rangelow);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) rangelow = si476x_to_v4l2(radio->core, rangelow);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) if (!rangehigh) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) err = regmap_read(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) SI476X_PROP_SEEK_BAND_TOP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) &rangehigh);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) rangehigh = si476x_to_v4l2(radio->core, rangehigh);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) if (rangelow > rangehigh) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) if (si476x_radio_range_is_inside_of_the_band(rangelow, rangehigh,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) SI476X_BAND_FM)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) func = SI476X_FUNC_FM_RECEIVER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) } else if (si476x_core_has_am(radio->core) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) si476x_radio_range_is_inside_of_the_band(rangelow, rangehigh,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) SI476X_BAND_AM)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) func = SI476X_FUNC_AM_RECEIVER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) err = si476x_radio_change_func(radio, func);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) if (seek->rangehigh) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) err = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) SI476X_PROP_SEEK_BAND_TOP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) v4l2_to_si476x(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) seek->rangehigh));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) if (seek->rangelow) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) err = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) SI476X_PROP_SEEK_BAND_BOTTOM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) v4l2_to_si476x(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) seek->rangelow));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) if (seek->spacing) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) err = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) SI476X_PROP_SEEK_FREQUENCY_SPACING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811) v4l2_to_si476x(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) seek->spacing));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) err = radio->ops->seek_start(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) seek->seek_upward,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) seek->wrap_around);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) unlock:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828) static int si476x_radio_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) struct si476x_radio *radio = v4l2_ctrl_handler_to_radio(ctrl->handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835) switch (ctrl->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836) case V4L2_CID_SI476X_INTERCHIP_LINK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) if (si476x_core_has_diversity(radio->core)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) if (radio->ops->phase_diversity) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839) retval = radio->ops->phase_div_status(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) ctrl->val = !!SI476X_PHDIV_STATUS_LINK_LOCKED(retval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) retval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) retval = -ENOTTY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851) retval = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854) retval = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) static int si476x_radio_s_ctrl(struct v4l2_ctrl *ctrl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) enum si476x_phase_diversity_mode mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) struct si476x_radio *radio = v4l2_ctrl_handler_to_radio(ctrl->handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) switch (ctrl->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) case V4L2_CID_SI476X_HARMONICS_COUNT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872) retval = regmap_update_bits(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) SI476X_PROP_AUDIO_PWR_LINE_FILTER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) SI476X_PROP_PWR_HARMONICS_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875) ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) case V4L2_CID_POWER_LINE_FREQUENCY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) switch (ctrl->val) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) case V4L2_CID_POWER_LINE_FREQUENCY_DISABLED:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) retval = regmap_update_bits(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) SI476X_PROP_AUDIO_PWR_LINE_FILTER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) SI476X_PROP_PWR_ENABLE_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) case V4L2_CID_POWER_LINE_FREQUENCY_50HZ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) retval = regmap_update_bits(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) SI476X_PROP_AUDIO_PWR_LINE_FILTER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) SI476X_PROP_PWR_GRID_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889) SI476X_PROP_PWR_GRID_50HZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) case V4L2_CID_POWER_LINE_FREQUENCY_60HZ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892) retval = regmap_update_bits(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) SI476X_PROP_AUDIO_PWR_LINE_FILTER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) SI476X_PROP_PWR_GRID_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) SI476X_PROP_PWR_GRID_60HZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 896) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 897) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 898) retval = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 899) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 900) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 901) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 902) case V4L2_CID_SI476X_RSSI_THRESHOLD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 903) retval = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 904) SI476X_PROP_VALID_RSSI_THRESHOLD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 905) ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 906) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 907) case V4L2_CID_SI476X_SNR_THRESHOLD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 908) retval = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 909) SI476X_PROP_VALID_SNR_THRESHOLD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 910) ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 911) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 912) case V4L2_CID_SI476X_MAX_TUNE_ERROR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 913) retval = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 914) SI476X_PROP_VALID_MAX_TUNE_ERROR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 915) ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 916) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 917) case V4L2_CID_RDS_RECEPTION:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 918) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 919) * It looks like RDS related properties are
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 920) * inaccesable when tuner is in AM mode, so cache the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 921) * changes
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 922) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 923) if (si476x_core_is_in_am_receiver_mode(radio->core))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 924) regcache_cache_only(radio->core->regmap, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 925)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 926) if (ctrl->val) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 927) retval = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 928) SI476X_PROP_FM_RDS_INTERRUPT_FIFO_COUNT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 929) radio->core->rds_fifo_depth);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 930) if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 931) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 932)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 933) if (radio->core->client->irq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 934) retval = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 935) SI476X_PROP_FM_RDS_INTERRUPT_SOURCE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 936) SI476X_RDSRECV);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 937) if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 938) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 939) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 940)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 941) /* Drain RDS FIFO before enabling RDS processing */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 942) retval = si476x_core_cmd_fm_rds_status(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 943) false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 944) true,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 945) true,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 946) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 947) if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 948) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 949)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 950) retval = regmap_update_bits(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 951) SI476X_PROP_FM_RDS_CONFIG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 952) SI476X_PROP_RDSEN_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 953) SI476X_PROP_RDSEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 954) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 955) retval = regmap_update_bits(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 956) SI476X_PROP_FM_RDS_CONFIG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 957) SI476X_PROP_RDSEN_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 958) !SI476X_PROP_RDSEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 959) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 960)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 961) if (si476x_core_is_in_am_receiver_mode(radio->core))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 962) regcache_cache_only(radio->core->regmap, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 963) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 964) case V4L2_CID_TUNE_DEEMPHASIS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 965) retval = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 966) SI476X_PROP_AUDIO_DEEMPHASIS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 967) ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 968) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 969)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 970) case V4L2_CID_SI476X_DIVERSITY_MODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 971) mode = si476x_phase_diversity_idx_to_mode(ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 972)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 973) if (mode == radio->core->diversity_mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 974) retval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 975) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 976) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 977)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 978) if (si476x_core_is_in_am_receiver_mode(radio->core)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 979) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 980) * Diversity cannot be configured while tuner
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 981) * is in AM mode so save the changes and carry on.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 982) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 983) radio->core->diversity_mode = mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 984) retval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 985) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 986) retval = radio->ops->phase_diversity(radio->core, mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 987) if (!retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 988) radio->core->diversity_mode = mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 989) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 990) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 991)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 992) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 993) retval = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 994) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 995) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 996)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 997) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 998)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 999) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1000) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1001)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1002) #ifdef CONFIG_VIDEO_ADV_DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1003) static int si476x_radio_g_register(struct file *file, void *fh,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1004) struct v4l2_dbg_register *reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1005) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1006) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1007) unsigned int value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1008) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1009)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1010) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1011) reg->size = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1012) err = regmap_read(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1013) (unsigned int)reg->reg, &value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1014) reg->val = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1015) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1016)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1017) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1018) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1019) static int si476x_radio_s_register(struct file *file, void *fh,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1020) const struct v4l2_dbg_register *reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1021) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1022)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1023) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1024) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1025)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1026) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1027) err = regmap_write(radio->core->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1028) (unsigned int)reg->reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1029) (unsigned int)reg->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1030) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1031)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1032) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1033) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1034) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1035)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1036) static int si476x_radio_fops_open(struct file *file)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1037) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1038) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1039) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1040)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1041) err = v4l2_fh_open(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1042) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1043) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1044)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1045) if (v4l2_fh_is_singular_file(file)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1046) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1047) err = si476x_core_set_power_state(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1048) SI476X_POWER_UP_FULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1049) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1050) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1051)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1052) err = si476x_radio_do_post_powerup_init(radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1053) radio->core->power_up_parameters.func);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1054) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1055) goto power_down;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1056)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1057) err = si476x_radio_pretune(radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1058) radio->core->power_up_parameters.func);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1059) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1060) goto power_down;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1061)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1062) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1063) /*Must be done after si476x_core_unlock to prevent a deadlock*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1064) v4l2_ctrl_handler_setup(&radio->ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1065) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1066)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1067) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1068)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1069) power_down:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1070) si476x_core_set_power_state(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1071) SI476X_POWER_DOWN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1072) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1073) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1074) v4l2_fh_release(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1075)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1076) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1077) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1078)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1079) static int si476x_radio_fops_release(struct file *file)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1080) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1081) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1082) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1083)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1084) if (v4l2_fh_is_singular_file(file) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1085) atomic_read(&radio->core->is_alive))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1086) si476x_core_set_power_state(radio->core,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1087) SI476X_POWER_DOWN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1088)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1089) err = v4l2_fh_release(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1090)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1091) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1092) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1093)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1094) static ssize_t si476x_radio_fops_read(struct file *file, char __user *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1095) size_t count, loff_t *ppos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1096) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1097) ssize_t rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1098) size_t fifo_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1099) unsigned int copied;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1101) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1103) /* block if no new data available */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1104) if (kfifo_is_empty(&radio->core->rds_fifo)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1105) if (file->f_flags & O_NONBLOCK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1106) return -EWOULDBLOCK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1108) rval = wait_event_interruptible(radio->core->rds_read_queue,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1109) (!kfifo_is_empty(&radio->core->rds_fifo) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1110) !atomic_read(&radio->core->is_alive)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1111) if (rval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1112) return -EINTR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1114) if (!atomic_read(&radio->core->is_alive))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1115) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1118) fifo_len = kfifo_len(&radio->core->rds_fifo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1120) if (kfifo_to_user(&radio->core->rds_fifo, buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1121) min(fifo_len, count),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1122) &copied) != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1123) dev_warn(&radio->videodev.dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1124) "Error during FIFO to userspace copy\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1125) rval = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1126) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1127) rval = (ssize_t)copied;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1130) return rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1131) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1133) static __poll_t si476x_radio_fops_poll(struct file *file,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1134) struct poll_table_struct *pts)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1135) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1136) struct si476x_radio *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1137) __poll_t req_events = poll_requested_events(pts);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1138) __poll_t err = v4l2_ctrl_poll(file, pts);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1140) if (req_events & (EPOLLIN | EPOLLRDNORM)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1141) if (atomic_read(&radio->core->is_alive))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1142) poll_wait(file, &radio->core->rds_read_queue, pts);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1144) if (!atomic_read(&radio->core->is_alive))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1145) err = EPOLLHUP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1147) if (!kfifo_is_empty(&radio->core->rds_fifo))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1148) err = EPOLLIN | EPOLLRDNORM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1149) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1151) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1152) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1154) static const struct v4l2_file_operations si476x_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1155) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1156) .read = si476x_radio_fops_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1157) .poll = si476x_radio_fops_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1158) .unlocked_ioctl = video_ioctl2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1159) .open = si476x_radio_fops_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1160) .release = si476x_radio_fops_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1161) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1163)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1164) static const struct v4l2_ioctl_ops si4761_ioctl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1165) .vidioc_querycap = si476x_radio_querycap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1166) .vidioc_g_tuner = si476x_radio_g_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1167) .vidioc_s_tuner = si476x_radio_s_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1169) .vidioc_g_frequency = si476x_radio_g_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1170) .vidioc_s_frequency = si476x_radio_s_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1171) .vidioc_s_hw_freq_seek = si476x_radio_s_hw_freq_seek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1172) .vidioc_enum_freq_bands = si476x_radio_enum_freq_bands,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1174) .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1175) .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1177) #ifdef CONFIG_VIDEO_ADV_DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1178) .vidioc_g_register = si476x_radio_g_register,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1179) .vidioc_s_register = si476x_radio_s_register,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1180) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1181) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1182)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1184) static const struct video_device si476x_viddev_template = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1185) .fops = &si476x_fops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1186) .name = DRIVER_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1187) .release = video_device_release_empty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1188) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1190)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1191)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1192) static ssize_t si476x_radio_read_acf_blob(struct file *file,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1193) char __user *user_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1194) size_t count, loff_t *ppos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1195) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1196) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1197) struct si476x_radio *radio = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1198) struct si476x_acf_status_report report;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1199)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1200) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1201) if (radio->ops->acf_status)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1202) err = radio->ops->acf_status(radio->core, &report);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1203) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1204) err = -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1205) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1207) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1208) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1210) return simple_read_from_buffer(user_buf, count, ppos, &report,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1211) sizeof(report));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1212) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1213)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1214) static const struct file_operations radio_acf_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1215) .open = simple_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1216) .llseek = default_llseek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1217) .read = si476x_radio_read_acf_blob,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1218) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1219)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1220) static ssize_t si476x_radio_read_rds_blckcnt_blob(struct file *file,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1221) char __user *user_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1222) size_t count, loff_t *ppos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1223) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1224) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1225) struct si476x_radio *radio = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1226) struct si476x_rds_blockcount_report report;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1227)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1228) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1229) if (radio->ops->rds_blckcnt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1230) err = radio->ops->rds_blckcnt(radio->core, true,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1231) &report);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1232) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1233) err = -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1234) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1235)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1236) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1237) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1239) return simple_read_from_buffer(user_buf, count, ppos, &report,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1240) sizeof(report));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1241) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1243) static const struct file_operations radio_rds_blckcnt_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1244) .open = simple_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1245) .llseek = default_llseek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1246) .read = si476x_radio_read_rds_blckcnt_blob,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1247) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1249) static ssize_t si476x_radio_read_agc_blob(struct file *file,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1250) char __user *user_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1251) size_t count, loff_t *ppos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1252) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1253) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1254) struct si476x_radio *radio = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1255) struct si476x_agc_status_report report;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1257) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1258) if (radio->ops->rds_blckcnt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1259) err = radio->ops->agc_status(radio->core, &report);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1260) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1261) err = -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1262) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1264) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1265) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1266)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1267) return simple_read_from_buffer(user_buf, count, ppos, &report,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1268) sizeof(report));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1269) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1270)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1271) static const struct file_operations radio_agc_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1272) .open = simple_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1273) .llseek = default_llseek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1274) .read = si476x_radio_read_agc_blob,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1275) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1277) static ssize_t si476x_radio_read_rsq_blob(struct file *file,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1278) char __user *user_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1279) size_t count, loff_t *ppos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1280) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1281) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1282) struct si476x_radio *radio = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1283) struct si476x_rsq_status_report report;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1284) struct si476x_rsq_status_args args = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1285) .primary = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1286) .rsqack = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1287) .attune = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1288) .cancel = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1289) .stcack = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1290) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1292) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1293) if (radio->ops->rds_blckcnt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1294) err = radio->ops->rsq_status(radio->core, &args, &report);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1295) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1296) err = -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1297) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1298)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1299) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1300) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1302) return simple_read_from_buffer(user_buf, count, ppos, &report,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1303) sizeof(report));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1304) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1305)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1306) static const struct file_operations radio_rsq_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1307) .open = simple_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1308) .llseek = default_llseek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1309) .read = si476x_radio_read_rsq_blob,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1310) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1312) static ssize_t si476x_radio_read_rsq_primary_blob(struct file *file,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1313) char __user *user_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1314) size_t count, loff_t *ppos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1315) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1316) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1317) struct si476x_radio *radio = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1318) struct si476x_rsq_status_report report;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1319) struct si476x_rsq_status_args args = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1320) .primary = true,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1321) .rsqack = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1322) .attune = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1323) .cancel = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1324) .stcack = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1325) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1327) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1328) if (radio->ops->rds_blckcnt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1329) err = radio->ops->rsq_status(radio->core, &args, &report);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1330) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1331) err = -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1332) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1334) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1335) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1336)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1337) return simple_read_from_buffer(user_buf, count, ppos, &report,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1338) sizeof(report));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1339) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1340)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1341) static const struct file_operations radio_rsq_primary_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1342) .open = simple_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1343) .llseek = default_llseek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1344) .read = si476x_radio_read_rsq_primary_blob,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1345) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1346)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1348) static void si476x_radio_init_debugfs(struct si476x_radio *radio)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1349) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1350) radio->debugfs = debugfs_create_dir(dev_name(radio->v4l2dev.dev), NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1351)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1352) debugfs_create_file("acf", S_IRUGO, radio->debugfs, radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1353) &radio_acf_fops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1355) debugfs_create_file("rds_blckcnt", S_IRUGO, radio->debugfs, radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1356) &radio_rds_blckcnt_fops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1358) debugfs_create_file("agc", S_IRUGO, radio->debugfs, radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1359) &radio_agc_fops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1360)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1361) debugfs_create_file("rsq", S_IRUGO, radio->debugfs, radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1362) &radio_rsq_fops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1364) debugfs_create_file("rsq_primary", S_IRUGO, radio->debugfs, radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1365) &radio_rsq_primary_fops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1366) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1367)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1369) static int si476x_radio_add_new_custom(struct si476x_radio *radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1370) enum si476x_ctrl_idx idx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1371) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1372) int rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1373) struct v4l2_ctrl *ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1374)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1375) ctrl = v4l2_ctrl_new_custom(&radio->ctrl_handler,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1376) &si476x_ctrls[idx],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1377) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1378) rval = radio->ctrl_handler.error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1379) if (ctrl == NULL && rval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1380) dev_err(radio->v4l2dev.dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1381) "Could not initialize '%s' control %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1382) si476x_ctrls[idx].name, rval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1384) return rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1385) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1386)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1387) static int si476x_radio_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1388) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1389) int rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1390) struct si476x_radio *radio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1391) struct v4l2_ctrl *ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1392)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1393) static atomic_t instance = ATOMIC_INIT(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1395) radio = devm_kzalloc(&pdev->dev, sizeof(*radio), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1396) if (!radio)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1397) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1398)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1399) radio->core = i2c_mfd_cell_to_core(&pdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1400)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1401) v4l2_device_set_name(&radio->v4l2dev, DRIVER_NAME, &instance);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1402)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1403) rval = v4l2_device_register(&pdev->dev, &radio->v4l2dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1404) if (rval) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1405) dev_err(&pdev->dev, "Cannot register v4l2_device.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1406) return rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1407) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1409) memcpy(&radio->videodev, &si476x_viddev_template,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1410) sizeof(struct video_device));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1411)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1412) radio->videodev.v4l2_dev = &radio->v4l2dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1413) radio->videodev.ioctl_ops = &si4761_ioctl_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1414) radio->videodev.device_caps = V4L2_CAP_TUNER | V4L2_CAP_RADIO |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1415) V4L2_CAP_HW_FREQ_SEEK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1416)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1417) si476x_core_lock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1418) if (!si476x_core_is_a_secondary_tuner(radio->core))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1419) radio->videodev.device_caps |= V4L2_CAP_RDS_CAPTURE |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1420) V4L2_CAP_READWRITE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1421) si476x_core_unlock(radio->core);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1422)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1423) video_set_drvdata(&radio->videodev, radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1424) platform_set_drvdata(pdev, radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1427) radio->v4l2dev.ctrl_handler = &radio->ctrl_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1428) v4l2_ctrl_handler_init(&radio->ctrl_handler,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1429) 1 + ARRAY_SIZE(si476x_ctrls));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1431) if (si476x_core_has_am(radio->core)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1432) ctrl = v4l2_ctrl_new_std_menu(&radio->ctrl_handler,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1433) &si476x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1434) V4L2_CID_POWER_LINE_FREQUENCY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1435) V4L2_CID_POWER_LINE_FREQUENCY_60HZ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1436) 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1437) rval = radio->ctrl_handler.error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1438) if (ctrl == NULL && rval) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1439) dev_err(&pdev->dev, "Could not initialize V4L2_CID_POWER_LINE_FREQUENCY control %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1440) rval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1441) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1442) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1443)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1444) rval = si476x_radio_add_new_custom(radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1445) SI476X_IDX_HARMONICS_COUNT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1446) if (rval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1447) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1448) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1450) rval = si476x_radio_add_new_custom(radio, SI476X_IDX_RSSI_THRESHOLD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1451) if (rval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1452) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1453)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1454) rval = si476x_radio_add_new_custom(radio, SI476X_IDX_SNR_THRESHOLD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1455) if (rval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1456) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1458) rval = si476x_radio_add_new_custom(radio, SI476X_IDX_MAX_TUNE_ERROR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1459) if (rval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1460) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1462) ctrl = v4l2_ctrl_new_std_menu(&radio->ctrl_handler,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1463) &si476x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1464) V4L2_CID_TUNE_DEEMPHASIS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1465) V4L2_DEEMPHASIS_75_uS, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1466) rval = radio->ctrl_handler.error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1467) if (ctrl == NULL && rval) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1468) dev_err(&pdev->dev, "Could not initialize V4L2_CID_TUNE_DEEMPHASIS control %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1469) rval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1470) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1471) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1473) ctrl = v4l2_ctrl_new_std(&radio->ctrl_handler, &si476x_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1474) V4L2_CID_RDS_RECEPTION,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1475) 0, 1, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1476) rval = radio->ctrl_handler.error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1477) if (ctrl == NULL && rval) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1478) dev_err(&pdev->dev, "Could not initialize V4L2_CID_RDS_RECEPTION control %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1479) rval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1480) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1481) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1483) if (si476x_core_has_diversity(radio->core)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1484) si476x_ctrls[SI476X_IDX_DIVERSITY_MODE].def =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1485) si476x_phase_diversity_mode_to_idx(radio->core->diversity_mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1486) rval = si476x_radio_add_new_custom(radio, SI476X_IDX_DIVERSITY_MODE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1487) if (rval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1488) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1489)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1490) rval = si476x_radio_add_new_custom(radio, SI476X_IDX_INTERCHIP_LINK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1491) if (rval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1492) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1493) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1495) /* register video device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1496) rval = video_register_device(&radio->videodev, VFL_TYPE_RADIO, -1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1497) if (rval < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1498) dev_err(&pdev->dev, "Could not register video device\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1499) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1500) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1501)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1502) si476x_radio_init_debugfs(radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1503)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1504) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1505) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1506) v4l2_ctrl_handler_free(radio->videodev.ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1507) return rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1508) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1509)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1510) static int si476x_radio_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1511) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1512) struct si476x_radio *radio = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1513)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1514) v4l2_ctrl_handler_free(radio->videodev.ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1515) video_unregister_device(&radio->videodev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1516) v4l2_device_unregister(&radio->v4l2dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1517) debugfs_remove_recursive(radio->debugfs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1518)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1519) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1520) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1521)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1522) MODULE_ALIAS("platform:si476x-radio");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1523)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1524) static struct platform_driver si476x_radio_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1525) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1526) .name = DRIVER_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1527) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1528) .probe = si476x_radio_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1529) .remove = si476x_radio_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1530) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1531) module_platform_driver(si476x_radio_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1532)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1533) MODULE_AUTHOR("Andrey Smirnov <andrew.smirnov@gmail.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1534) MODULE_DESCRIPTION("Driver for Si4761/64/68 AM/FM Radio MFD Cell");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1535) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags