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