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