cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

max2175.c (38554B)


      1// SPDX-License-Identifier: GPL-2.0
      2/*
      3 * Maxim Integrated MAX2175 RF to Bits tuner driver
      4 *
      5 * This driver & most of the hard coded values are based on the reference
      6 * application delivered by Maxim for this device.
      7 *
      8 * Copyright (C) 2016 Maxim Integrated Products
      9 * Copyright (C) 2017 Renesas Electronics Corporation
     10 */
     11
     12#include <linux/clk.h>
     13#include <linux/delay.h>
     14#include <linux/errno.h>
     15#include <linux/i2c.h>
     16#include <linux/kernel.h>
     17#include <linux/math64.h>
     18#include <linux/max2175.h>
     19#include <linux/module.h>
     20#include <linux/of.h>
     21#include <linux/regmap.h>
     22#include <linux/slab.h>
     23#include <media/v4l2-ctrls.h>
     24#include <media/v4l2-device.h>
     25
     26#include "max2175.h"
     27
     28#define DRIVER_NAME "max2175"
     29
     30#define mxm_dbg(ctx, fmt, arg...) dev_dbg(&ctx->client->dev, fmt, ## arg)
     31#define mxm_err(ctx, fmt, arg...) dev_err(&ctx->client->dev, fmt, ## arg)
     32
     33/* Rx mode */
     34struct max2175_rxmode {
     35	enum max2175_band band;		/* Associated band */
     36	u32 freq;			/* Default freq in Hz */
     37	u8 i2s_word_size;		/* Bit value */
     38};
     39
     40/* Register map to define preset values */
     41struct max2175_reg_map {
     42	u8 idx;				/* Register index */
     43	u8 val;				/* Register value */
     44};
     45
     46static const struct max2175_rxmode eu_rx_modes[] = {
     47	/* EU modes */
     48	[MAX2175_EU_FM_1_2] = { MAX2175_BAND_FM, 98256000, 1 },
     49	[MAX2175_DAB_1_2]   = { MAX2175_BAND_VHF, 182640000, 0 },
     50};
     51
     52static const struct max2175_rxmode na_rx_modes[] = {
     53	/* NA modes */
     54	[MAX2175_NA_FM_1_0] = { MAX2175_BAND_FM, 98255520, 1 },
     55	[MAX2175_NA_FM_2_0] = { MAX2175_BAND_FM, 98255520, 6 },
     56};
     57
     58/*
     59 * Preset values:
     60 * Based on Maxim MAX2175 Register Table revision: 130p10
     61 */
     62static const u8 full_fm_eu_1p0[] = {
     63	0x15, 0x04, 0xb8, 0xe3, 0x35, 0x18, 0x7c, 0x00,
     64	0x00, 0x7d, 0x40, 0x08, 0x70, 0x7a, 0x88, 0x91,
     65	0x61, 0x61, 0x61, 0x61, 0x5a, 0x0f, 0x34, 0x1c,
     66	0x14, 0x88, 0x33, 0x02, 0x00, 0x09, 0x00, 0x65,
     67	0x9f, 0x2b, 0x80, 0x00, 0x95, 0x05, 0x2c, 0x00,
     68	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40,
     69	0x4a, 0x08, 0xa8, 0x0e, 0x0e, 0x2f, 0x7e, 0x00,
     70	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
     71	0x00, 0x00, 0x00, 0x00, 0x00, 0xab, 0x5e, 0xa9,
     72	0xae, 0xbb, 0x57, 0x18, 0x3b, 0x03, 0x3b, 0x64,
     73	0x40, 0x60, 0x00, 0x2a, 0xbf, 0x3f, 0xff, 0x9f,
     74	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0a, 0x00,
     75	0xff, 0xfc, 0xef, 0x1c, 0x40, 0x00, 0x00, 0x02,
     76	0x00, 0x00, 0xe0, 0x00, 0x00, 0x00, 0x00, 0x00,
     77	0x00, 0x00, 0x00, 0x00, 0x00, 0xac, 0x40, 0x00,
     78	0x00, 0x00, 0x00, 0x00, 0x00, 0x75, 0x00, 0x00,
     79	0x00, 0x47, 0x00, 0x00, 0x11, 0x3f, 0x22, 0x00,
     80	0xf1, 0x00, 0x41, 0x03, 0xb0, 0x00, 0x00, 0x00,
     81	0x1b,
     82};
     83
     84static const u8 full_fm_na_1p0[] = {
     85	0x13, 0x08, 0x8d, 0xc0, 0x35, 0x18, 0x7d, 0x3f,
     86	0x7d, 0x75, 0x40, 0x08, 0x70, 0x7a, 0x88, 0x91,
     87	0x61, 0x61, 0x61, 0x61, 0x5c, 0x0f, 0x34, 0x1c,
     88	0x14, 0x88, 0x33, 0x02, 0x00, 0x01, 0x00, 0x65,
     89	0x9f, 0x2b, 0x80, 0x00, 0x95, 0x05, 0x2c, 0x00,
     90	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40,
     91	0x4a, 0x08, 0xa8, 0x0e, 0x0e, 0xaf, 0x7e, 0x00,
     92	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
     93	0x00, 0x00, 0x00, 0x00, 0x00, 0xab, 0x5e, 0xa9,
     94	0xae, 0xbb, 0x57, 0x18, 0x3b, 0x03, 0x3b, 0x64,
     95	0x40, 0x60, 0x00, 0x2a, 0xbf, 0x3f, 0xff, 0x9f,
     96	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0a, 0x00,
     97	0xff, 0xfc, 0xef, 0x1c, 0x40, 0x00, 0x00, 0x02,
     98	0x00, 0x00, 0xe0, 0x00, 0x00, 0x00, 0x00, 0x00,
     99	0x00, 0x00, 0x00, 0x00, 0x00, 0xa6, 0x40, 0x00,
    100	0x00, 0x00, 0x00, 0x00, 0x00, 0x75, 0x00, 0x00,
    101	0x00, 0x35, 0x00, 0x00, 0x11, 0x3f, 0x22, 0x00,
    102	0xf1, 0x00, 0x41, 0x03, 0xb0, 0x00, 0x00, 0x00,
    103	0x1b,
    104};
    105
    106/* DAB1.2 settings */
    107static const struct max2175_reg_map dab12_map[] = {
    108	{ 0x01, 0x13 }, { 0x02, 0x0d }, { 0x03, 0x15 }, { 0x04, 0x55 },
    109	{ 0x05, 0x0a }, { 0x06, 0xa0 }, { 0x07, 0x40 }, { 0x08, 0x00 },
    110	{ 0x09, 0x00 }, { 0x0a, 0x7d }, { 0x0b, 0x4a }, { 0x0c, 0x28 },
    111	{ 0x0e, 0x43 }, { 0x0f, 0xb5 }, { 0x10, 0x31 }, { 0x11, 0x9e },
    112	{ 0x12, 0x68 }, { 0x13, 0x9e }, { 0x14, 0x68 }, { 0x15, 0x58 },
    113	{ 0x16, 0x2f }, { 0x17, 0x3f }, { 0x18, 0x40 }, { 0x1a, 0x88 },
    114	{ 0x1b, 0xaa }, { 0x1c, 0x9a }, { 0x1d, 0x00 }, { 0x1e, 0x00 },
    115	{ 0x23, 0x80 }, { 0x24, 0x00 }, { 0x25, 0x00 }, { 0x26, 0x00 },
    116	{ 0x27, 0x00 }, { 0x32, 0x08 }, { 0x33, 0xf8 }, { 0x36, 0x2d },
    117	{ 0x37, 0x7e }, { 0x55, 0xaf }, { 0x56, 0x3f }, { 0x57, 0xf8 },
    118	{ 0x58, 0x99 }, { 0x76, 0x00 }, { 0x77, 0x00 }, { 0x78, 0x02 },
    119	{ 0x79, 0x40 }, { 0x82, 0x00 }, { 0x83, 0x00 }, { 0x85, 0x00 },
    120	{ 0x86, 0x20 },
    121};
    122
    123/* EU FM 1.2 settings */
    124static const struct max2175_reg_map fmeu1p2_map[] = {
    125	{ 0x01, 0x15 }, { 0x02, 0x04 }, { 0x03, 0xb8 }, { 0x04, 0xe3 },
    126	{ 0x05, 0x35 }, { 0x06, 0x18 }, { 0x07, 0x7c }, { 0x08, 0x00 },
    127	{ 0x09, 0x00 }, { 0x0a, 0x73 }, { 0x0b, 0x40 }, { 0x0c, 0x08 },
    128	{ 0x0e, 0x7a }, { 0x0f, 0x88 }, { 0x10, 0x91 }, { 0x11, 0x61 },
    129	{ 0x12, 0x61 }, { 0x13, 0x61 }, { 0x14, 0x61 }, { 0x15, 0x5a },
    130	{ 0x16, 0x0f }, { 0x17, 0x34 }, { 0x18, 0x1c }, { 0x1a, 0x88 },
    131	{ 0x1b, 0x33 }, { 0x1c, 0x02 }, { 0x1d, 0x00 }, { 0x1e, 0x01 },
    132	{ 0x23, 0x80 }, { 0x24, 0x00 }, { 0x25, 0x95 }, { 0x26, 0x05 },
    133	{ 0x27, 0x2c }, { 0x32, 0x08 }, { 0x33, 0xa8 }, { 0x36, 0x2f },
    134	{ 0x37, 0x7e }, { 0x55, 0xbf }, { 0x56, 0x3f }, { 0x57, 0xff },
    135	{ 0x58, 0x9f }, { 0x76, 0xac }, { 0x77, 0x40 }, { 0x78, 0x00 },
    136	{ 0x79, 0x00 }, { 0x82, 0x47 }, { 0x83, 0x00 }, { 0x85, 0x11 },
    137	{ 0x86, 0x3f },
    138};
    139
    140/* FM NA 1.0 settings */
    141static const struct max2175_reg_map fmna1p0_map[] = {
    142	{ 0x01, 0x13 }, { 0x02, 0x08 }, { 0x03, 0x8d }, { 0x04, 0xc0 },
    143	{ 0x05, 0x35 }, { 0x06, 0x18 }, { 0x07, 0x7d }, { 0x08, 0x3f },
    144	{ 0x09, 0x7d }, { 0x0a, 0x75 }, { 0x0b, 0x40 }, { 0x0c, 0x08 },
    145	{ 0x0e, 0x7a }, { 0x0f, 0x88 }, { 0x10, 0x91 }, { 0x11, 0x61 },
    146	{ 0x12, 0x61 }, { 0x13, 0x61 }, { 0x14, 0x61 }, { 0x15, 0x5c },
    147	{ 0x16, 0x0f }, { 0x17, 0x34 }, { 0x18, 0x1c }, { 0x1a, 0x88 },
    148	{ 0x1b, 0x33 }, { 0x1c, 0x02 }, { 0x1d, 0x00 }, { 0x1e, 0x01 },
    149	{ 0x23, 0x80 }, { 0x24, 0x00 }, { 0x25, 0x95 }, { 0x26, 0x05 },
    150	{ 0x27, 0x2c }, { 0x32, 0x08 }, { 0x33, 0xa8 }, { 0x36, 0xaf },
    151	{ 0x37, 0x7e }, { 0x55, 0xbf }, { 0x56, 0x3f }, { 0x57, 0xff },
    152	{ 0x58, 0x9f }, { 0x76, 0xa6 }, { 0x77, 0x40 }, { 0x78, 0x00 },
    153	{ 0x79, 0x00 }, { 0x82, 0x35 }, { 0x83, 0x00 }, { 0x85, 0x11 },
    154	{ 0x86, 0x3f },
    155};
    156
    157/* FM NA 2.0 settings */
    158static const struct max2175_reg_map fmna2p0_map[] = {
    159	{ 0x01, 0x13 }, { 0x02, 0x08 }, { 0x03, 0x8d }, { 0x04, 0xc0 },
    160	{ 0x05, 0x35 }, { 0x06, 0x18 }, { 0x07, 0x7c }, { 0x08, 0x54 },
    161	{ 0x09, 0xa7 }, { 0x0a, 0x55 }, { 0x0b, 0x42 }, { 0x0c, 0x48 },
    162	{ 0x0e, 0x7a }, { 0x0f, 0x88 }, { 0x10, 0x91 }, { 0x11, 0x61 },
    163	{ 0x12, 0x61 }, { 0x13, 0x61 }, { 0x14, 0x61 }, { 0x15, 0x5c },
    164	{ 0x16, 0x0f }, { 0x17, 0x34 }, { 0x18, 0x1c }, { 0x1a, 0x88 },
    165	{ 0x1b, 0x33 }, { 0x1c, 0x02 }, { 0x1d, 0x00 }, { 0x1e, 0x01 },
    166	{ 0x23, 0x80 }, { 0x24, 0x00 }, { 0x25, 0x95 }, { 0x26, 0x05 },
    167	{ 0x27, 0x2c }, { 0x32, 0x08 }, { 0x33, 0xa8 }, { 0x36, 0xaf },
    168	{ 0x37, 0x7e }, { 0x55, 0xbf }, { 0x56, 0x3f }, { 0x57, 0xff },
    169	{ 0x58, 0x9f }, { 0x76, 0xac }, { 0x77, 0xc0 }, { 0x78, 0x00 },
    170	{ 0x79, 0x00 }, { 0x82, 0x6b }, { 0x83, 0x00 }, { 0x85, 0x11 },
    171	{ 0x86, 0x3f },
    172};
    173
    174static const u16 ch_coeff_dab1[] = {
    175	0x001c, 0x0007, 0xffcd, 0x0056, 0xffa4, 0x0033, 0x0027, 0xff61,
    176	0x010e, 0xfec0, 0x0106, 0xffb8, 0xff1c, 0x023c, 0xfcb2, 0x039b,
    177	0xfd4e, 0x0055, 0x036a, 0xf7de, 0x0d21, 0xee72, 0x1499, 0x6a51,
    178};
    179
    180static const u16 ch_coeff_fmeu[] = {
    181	0x0000, 0xffff, 0x0001, 0x0002, 0xfffa, 0xffff, 0x0015, 0xffec,
    182	0xffde, 0x0054, 0xfff9, 0xff52, 0x00b8, 0x00a2, 0xfe0a, 0x00af,
    183	0x02e3, 0xfc14, 0xfe89, 0x089d, 0xfa2e, 0xf30f, 0x25be, 0x4eb6,
    184};
    185
    186static const u16 eq_coeff_fmeu1_ra02_m6db[] = {
    187	0x0040, 0xffc6, 0xfffa, 0x002c, 0x000d, 0xff90, 0x0037, 0x006e,
    188	0xffc0, 0xff5b, 0x006a, 0x00f0, 0xff57, 0xfe94, 0x0112, 0x0252,
    189	0xfe0c, 0xfc6a, 0x0385, 0x0553, 0xfa49, 0xf789, 0x0b91, 0x1a10,
    190};
    191
    192static const u16 ch_coeff_fmna[] = {
    193	0x0001, 0x0003, 0xfffe, 0xfff4, 0x0000, 0x001f, 0x000c, 0xffbc,
    194	0xffd3, 0x007d, 0x0075, 0xff33, 0xff01, 0x0131, 0x01ef, 0xfe60,
    195	0xfc7a, 0x020e, 0x0656, 0xfd94, 0xf395, 0x02ab, 0x2857, 0x3d3f,
    196};
    197
    198static const u16 eq_coeff_fmna1_ra02_m6db[] = {
    199	0xfff1, 0xffe1, 0xffef, 0x000e, 0x0030, 0x002f, 0xfff6, 0xffa7,
    200	0xff9d, 0x000a, 0x00a2, 0x00b5, 0xffea, 0xfed9, 0xfec5, 0x003d,
    201	0x0217, 0x021b, 0xff5a, 0xfc2b, 0xfcbd, 0x02c4, 0x0ac3, 0x0e85,
    202};
    203
    204static const u8 adc_presets[2][23] = {
    205	{
    206		0x83, 0x00, 0xcf, 0xb4, 0x0f, 0x2c, 0x0c, 0x49,
    207		0x00, 0x00, 0x00, 0x8c,	0x02, 0x02, 0x00, 0x04,
    208		0xec, 0x82, 0x4b, 0xcc, 0x01, 0x88, 0x0c,
    209	},
    210	{
    211		0x83, 0x00, 0xcf, 0xb4,	0x0f, 0x2c, 0x0c, 0x49,
    212		0x00, 0x00, 0x00, 0x8c,	0x02, 0x20, 0x33, 0x8c,
    213		0x57, 0xd7, 0x59, 0xb7,	0x65, 0x0e, 0x0c,
    214	},
    215};
    216
    217/* Tuner bands */
    218static const struct v4l2_frequency_band eu_bands_rf = {
    219	.tuner = 0,
    220	.type = V4L2_TUNER_RF,
    221	.index = 0,
    222	.capability = V4L2_TUNER_CAP_1HZ | V4L2_TUNER_CAP_FREQ_BANDS,
    223	.rangelow   = 65000000,
    224	.rangehigh  = 240000000,
    225};
    226
    227static const struct v4l2_frequency_band na_bands_rf = {
    228	.tuner = 0,
    229	.type = V4L2_TUNER_RF,
    230	.index = 0,
    231	.capability = V4L2_TUNER_CAP_1HZ | V4L2_TUNER_CAP_FREQ_BANDS,
    232	.rangelow   = 65000000,
    233	.rangehigh  = 108000000,
    234};
    235
    236/* Regmap settings */
    237static const struct regmap_range max2175_regmap_volatile_range[] = {
    238	regmap_reg_range(0x30, 0x35),
    239	regmap_reg_range(0x3a, 0x45),
    240	regmap_reg_range(0x59, 0x5e),
    241	regmap_reg_range(0x73, 0x75),
    242};
    243
    244static const struct regmap_access_table max2175_volatile_regs = {
    245	.yes_ranges = max2175_regmap_volatile_range,
    246	.n_yes_ranges = ARRAY_SIZE(max2175_regmap_volatile_range),
    247};
    248
    249static const struct reg_default max2175_reg_defaults[] = {
    250	{ 0x00, 0x07},
    251};
    252
    253static const struct regmap_config max2175_regmap_config = {
    254	.reg_bits = 8,
    255	.val_bits = 8,
    256	.max_register = 0xff,
    257	.reg_defaults = max2175_reg_defaults,
    258	.num_reg_defaults = ARRAY_SIZE(max2175_reg_defaults),
    259	.volatile_table = &max2175_volatile_regs,
    260	.cache_type = REGCACHE_RBTREE,
    261};
    262
    263struct max2175 {
    264	struct v4l2_subdev sd;		/* Sub-device */
    265	struct i2c_client *client;	/* I2C client */
    266
    267	/* Controls */
    268	struct v4l2_ctrl_handler ctrl_hdl;
    269	struct v4l2_ctrl *lna_gain;	/* LNA gain value */
    270	struct v4l2_ctrl *if_gain;	/* I/F gain value */
    271	struct v4l2_ctrl *pll_lock;	/* PLL lock */
    272	struct v4l2_ctrl *i2s_en;	/* I2S output enable */
    273	struct v4l2_ctrl *hsls;		/* High-side/Low-side polarity */
    274	struct v4l2_ctrl *rx_mode;	/* Receive mode */
    275
    276	/* Regmap */
    277	struct regmap *regmap;
    278
    279	/* Cached configuration */
    280	u32 freq;			/* Tuned freq In Hz */
    281	const struct max2175_rxmode *rx_modes;		/* EU or NA modes */
    282	const struct v4l2_frequency_band *bands_rf;	/* EU or NA bands */
    283
    284	/* Device settings */
    285	unsigned long xtal_freq;	/* Ref Oscillator freq in Hz */
    286	u32 decim_ratio;
    287	bool master;			/* Master/Slave */
    288	bool am_hiz;			/* AM Hi-Z filter */
    289
    290	/* ROM values */
    291	u8 rom_bbf_bw_am;
    292	u8 rom_bbf_bw_fm;
    293	u8 rom_bbf_bw_dab;
    294
    295	/* Driver private variables */
    296	bool mode_resolved;		/* Flag to sanity check settings */
    297};
    298
    299static inline struct max2175 *max2175_from_sd(struct v4l2_subdev *sd)
    300{
    301	return container_of(sd, struct max2175, sd);
    302}
    303
    304static inline struct max2175 *max2175_from_ctrl_hdl(struct v4l2_ctrl_handler *h)
    305{
    306	return container_of(h, struct max2175, ctrl_hdl);
    307}
    308
    309/* Get bitval of a given val */
    310static inline u8 max2175_get_bitval(u8 val, u8 msb, u8 lsb)
    311{
    312	return (val & GENMASK(msb, lsb)) >> lsb;
    313}
    314
    315/* Read/Write bit(s) on top of regmap */
    316static int max2175_read(struct max2175 *ctx, u8 idx, u8 *val)
    317{
    318	u32 regval;
    319	int ret;
    320
    321	ret = regmap_read(ctx->regmap, idx, &regval);
    322	if (ret)
    323		mxm_err(ctx, "read ret(%d): idx 0x%02x\n", ret, idx);
    324	else
    325		*val = regval;
    326
    327	return ret;
    328}
    329
    330static int max2175_write(struct max2175 *ctx, u8 idx, u8 val)
    331{
    332	int ret;
    333
    334	ret = regmap_write(ctx->regmap, idx, val);
    335	if (ret)
    336		mxm_err(ctx, "write ret(%d): idx 0x%02x val 0x%02x\n",
    337			ret, idx, val);
    338
    339	return ret;
    340}
    341
    342static u8 max2175_read_bits(struct max2175 *ctx, u8 idx, u8 msb, u8 lsb)
    343{
    344	u8 val;
    345
    346	if (max2175_read(ctx, idx, &val))
    347		return 0;
    348
    349	return max2175_get_bitval(val, msb, lsb);
    350}
    351
    352static int max2175_write_bits(struct max2175 *ctx, u8 idx,
    353			     u8 msb, u8 lsb, u8 newval)
    354{
    355	int ret = regmap_update_bits(ctx->regmap, idx, GENMASK(msb, lsb),
    356				     newval << lsb);
    357
    358	if (ret)
    359		mxm_err(ctx, "wbits ret(%d): idx 0x%02x\n", ret, idx);
    360
    361	return ret;
    362}
    363
    364static int max2175_write_bit(struct max2175 *ctx, u8 idx, u8 bit, u8 newval)
    365{
    366	return max2175_write_bits(ctx, idx, bit, bit, newval);
    367}
    368
    369/* Checks expected pattern every msec until timeout */
    370static int max2175_poll_timeout(struct max2175 *ctx, u8 idx, u8 msb, u8 lsb,
    371				u8 exp_bitval, u32 timeout_us)
    372{
    373	unsigned int val;
    374
    375	return regmap_read_poll_timeout(ctx->regmap, idx, val,
    376			(max2175_get_bitval(val, msb, lsb) == exp_bitval),
    377			1000, timeout_us);
    378}
    379
    380static int max2175_poll_csm_ready(struct max2175 *ctx)
    381{
    382	int ret;
    383
    384	ret = max2175_poll_timeout(ctx, 69, 1, 1, 0, 50000);
    385	if (ret)
    386		mxm_err(ctx, "csm not ready\n");
    387
    388	return ret;
    389}
    390
    391#define MAX2175_IS_BAND_AM(ctx)		\
    392	(max2175_read_bits(ctx, 5, 1, 0) == MAX2175_BAND_AM)
    393
    394#define MAX2175_IS_BAND_VHF(ctx)	\
    395	(max2175_read_bits(ctx, 5, 1, 0) == MAX2175_BAND_VHF)
    396
    397#define MAX2175_IS_FM_MODE(ctx)		\
    398	(max2175_read_bits(ctx, 12, 5, 4) == 0)
    399
    400#define MAX2175_IS_FMHD_MODE(ctx)	\
    401	(max2175_read_bits(ctx, 12, 5, 4) == 1)
    402
    403#define MAX2175_IS_DAB_MODE(ctx)	\
    404	(max2175_read_bits(ctx, 12, 5, 4) == 2)
    405
    406static int max2175_band_from_freq(u32 freq)
    407{
    408	if (freq >= 144000 && freq <= 26100000)
    409		return MAX2175_BAND_AM;
    410	else if (freq >= 65000000 && freq <= 108000000)
    411		return MAX2175_BAND_FM;
    412
    413	return MAX2175_BAND_VHF;
    414}
    415
    416static void max2175_i2s_enable(struct max2175 *ctx, bool enable)
    417{
    418	if (enable)
    419		/* Stuff bits are zeroed */
    420		max2175_write_bits(ctx, 104, 3, 0, 2);
    421	else
    422		/* Keep SCK alive */
    423		max2175_write_bits(ctx, 104, 3, 0, 9);
    424	mxm_dbg(ctx, "i2s %sabled\n", enable ? "en" : "dis");
    425}
    426
    427static void max2175_set_filter_coeffs(struct max2175 *ctx, u8 m_sel,
    428				      u8 bank, const u16 *coeffs)
    429{
    430	unsigned int i;
    431	u8 coeff_addr, upper_address = 24;
    432
    433	mxm_dbg(ctx, "set_filter_coeffs: m_sel %d bank %d\n", m_sel, bank);
    434	max2175_write_bits(ctx, 114, 5, 4, m_sel);
    435
    436	if (m_sel == 2)
    437		upper_address = 12;
    438
    439	for (i = 0; i < upper_address; i++) {
    440		coeff_addr = i + bank * 24;
    441		max2175_write(ctx, 115, coeffs[i] >> 8);
    442		max2175_write(ctx, 116, coeffs[i]);
    443		max2175_write(ctx, 117, coeff_addr | 1 << 7);
    444	}
    445	max2175_write_bit(ctx, 117, 7, 0);
    446}
    447
    448static void max2175_load_fmeu_1p2(struct max2175 *ctx)
    449{
    450	unsigned int i;
    451
    452	for (i = 0; i < ARRAY_SIZE(fmeu1p2_map); i++)
    453		max2175_write(ctx, fmeu1p2_map[i].idx, fmeu1p2_map[i].val);
    454
    455	ctx->decim_ratio = 36;
    456
    457	/* Load the Channel Filter Coefficients into channel filter bank #2 */
    458	max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 0, ch_coeff_fmeu);
    459	max2175_set_filter_coeffs(ctx, MAX2175_EQ_MSEL, 0,
    460				  eq_coeff_fmeu1_ra02_m6db);
    461}
    462
    463static void max2175_load_dab_1p2(struct max2175 *ctx)
    464{
    465	unsigned int i;
    466
    467	for (i = 0; i < ARRAY_SIZE(dab12_map); i++)
    468		max2175_write(ctx, dab12_map[i].idx, dab12_map[i].val);
    469
    470	ctx->decim_ratio = 1;
    471
    472	/* Load the Channel Filter Coefficients into channel filter bank #2 */
    473	max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 2, ch_coeff_dab1);
    474}
    475
    476static void max2175_load_fmna_1p0(struct max2175 *ctx)
    477{
    478	unsigned int i;
    479
    480	for (i = 0; i < ARRAY_SIZE(fmna1p0_map); i++)
    481		max2175_write(ctx, fmna1p0_map[i].idx, fmna1p0_map[i].val);
    482}
    483
    484static void max2175_load_fmna_2p0(struct max2175 *ctx)
    485{
    486	unsigned int i;
    487
    488	for (i = 0; i < ARRAY_SIZE(fmna2p0_map); i++)
    489		max2175_write(ctx, fmna2p0_map[i].idx, fmna2p0_map[i].val);
    490}
    491
    492static void max2175_set_bbfilter(struct max2175 *ctx)
    493{
    494	if (MAX2175_IS_BAND_AM(ctx)) {
    495		max2175_write_bits(ctx, 12, 3, 0, ctx->rom_bbf_bw_am);
    496		mxm_dbg(ctx, "set_bbfilter AM: rom %d\n", ctx->rom_bbf_bw_am);
    497	} else if (MAX2175_IS_DAB_MODE(ctx)) {
    498		max2175_write_bits(ctx, 12, 3, 0, ctx->rom_bbf_bw_dab);
    499		mxm_dbg(ctx, "set_bbfilter DAB: rom %d\n", ctx->rom_bbf_bw_dab);
    500	} else {
    501		max2175_write_bits(ctx, 12, 3, 0, ctx->rom_bbf_bw_fm);
    502		mxm_dbg(ctx, "set_bbfilter FM: rom %d\n", ctx->rom_bbf_bw_fm);
    503	}
    504}
    505
    506static int max2175_set_csm_mode(struct max2175 *ctx,
    507			  enum max2175_csm_mode new_mode)
    508{
    509	int ret = max2175_poll_csm_ready(ctx);
    510
    511	if (ret)
    512		return ret;
    513
    514	max2175_write_bits(ctx, 0, 2, 0, new_mode);
    515	mxm_dbg(ctx, "set csm new mode %d\n", new_mode);
    516
    517	/* Wait for a fixed settle down time depending on new mode */
    518	switch (new_mode) {
    519	case MAX2175_PRESET_TUNE:
    520		usleep_range(51100, 51500);	/* 51.1ms */
    521		break;
    522	/*
    523	 * Other mode switches need different sleep values depending on band &
    524	 * mode
    525	 */
    526	default:
    527		break;
    528	}
    529
    530	return max2175_poll_csm_ready(ctx);
    531}
    532
    533static int max2175_csm_action(struct max2175 *ctx,
    534			      enum max2175_csm_mode action)
    535{
    536	int ret;
    537
    538	mxm_dbg(ctx, "csm_action: %d\n", action);
    539
    540	/* Other actions can be added in future when needed */
    541	ret = max2175_set_csm_mode(ctx, MAX2175_LOAD_TO_BUFFER);
    542	if (ret)
    543		return ret;
    544
    545	return max2175_set_csm_mode(ctx, MAX2175_PRESET_TUNE);
    546}
    547
    548static int max2175_set_lo_freq(struct max2175 *ctx, u32 lo_freq)
    549{
    550	u8 lo_mult, loband_bits = 0, vcodiv_bits = 0;
    551	u32 int_desired, frac_desired;
    552	enum max2175_band band;
    553	int ret;
    554
    555	band = max2175_read_bits(ctx, 5, 1, 0);
    556	switch (band) {
    557	case MAX2175_BAND_AM:
    558		lo_mult = 16;
    559		break;
    560	case MAX2175_BAND_FM:
    561		if (lo_freq <= 74700000) {
    562			lo_mult = 16;
    563		} else if (lo_freq > 74700000 && lo_freq <= 110000000) {
    564			loband_bits = 1;
    565			lo_mult = 8;
    566		} else {
    567			loband_bits = 1;
    568			vcodiv_bits = 3;
    569			lo_mult = 8;
    570		}
    571		break;
    572	case MAX2175_BAND_VHF:
    573		if (lo_freq <= 210000000)
    574			vcodiv_bits = 2;
    575		else
    576			vcodiv_bits = 1;
    577
    578		loband_bits = 2;
    579		lo_mult = 4;
    580		break;
    581	default:
    582		loband_bits = 3;
    583		vcodiv_bits = 2;
    584		lo_mult = 2;
    585		break;
    586	}
    587
    588	if (band == MAX2175_BAND_L)
    589		lo_freq /= lo_mult;
    590	else
    591		lo_freq *= lo_mult;
    592
    593	int_desired = lo_freq / ctx->xtal_freq;
    594	frac_desired = div64_ul((u64)(lo_freq % ctx->xtal_freq) << 20,
    595				ctx->xtal_freq);
    596
    597	/* Check CSM is not busy */
    598	ret = max2175_poll_csm_ready(ctx);
    599	if (ret)
    600		return ret;
    601
    602	mxm_dbg(ctx, "lo_mult %u int %u  frac %u\n",
    603		lo_mult, int_desired, frac_desired);
    604
    605	/* Write the calculated values to the appropriate registers */
    606	max2175_write(ctx, 1, int_desired);
    607	max2175_write_bits(ctx, 2, 3, 0, (frac_desired >> 16) & 0xf);
    608	max2175_write(ctx, 3, frac_desired >> 8);
    609	max2175_write(ctx, 4, frac_desired);
    610	max2175_write_bits(ctx, 5, 3, 2, loband_bits);
    611	max2175_write_bits(ctx, 6, 7, 6, vcodiv_bits);
    612
    613	return ret;
    614}
    615
    616/*
    617 * Helper similar to DIV_ROUND_CLOSEST but an inline function that accepts s64
    618 * dividend and s32 divisor
    619 */
    620static inline s64 max2175_round_closest(s64 dividend, s32 divisor)
    621{
    622	if ((dividend > 0 && divisor > 0) || (dividend < 0 && divisor < 0))
    623		return div_s64(dividend + divisor / 2, divisor);
    624
    625	return div_s64(dividend - divisor / 2, divisor);
    626}
    627
    628static int max2175_set_nco_freq(struct max2175 *ctx, s32 nco_freq)
    629{
    630	s32 clock_rate = ctx->xtal_freq / ctx->decim_ratio;
    631	u32 nco_reg, abs_nco_freq = abs(nco_freq);
    632	s64 nco_val_desired;
    633	int ret;
    634
    635	if (abs_nco_freq < clock_rate / 2) {
    636		nco_val_desired = 2 * nco_freq;
    637	} else {
    638		nco_val_desired = 2LL * (clock_rate - abs_nco_freq);
    639		if (nco_freq < 0)
    640			nco_val_desired = -nco_val_desired;
    641	}
    642
    643	nco_reg = max2175_round_closest(nco_val_desired << 20, clock_rate);
    644
    645	if (nco_freq < 0)
    646		nco_reg += 0x200000;
    647
    648	/* Check CSM is not busy */
    649	ret = max2175_poll_csm_ready(ctx);
    650	if (ret)
    651		return ret;
    652
    653	mxm_dbg(ctx, "freq %d desired %lld reg %u\n",
    654		nco_freq, nco_val_desired, nco_reg);
    655
    656	/* Write the calculated values to the appropriate registers */
    657	max2175_write_bits(ctx, 7, 4, 0, (nco_reg >> 16) & 0x1f);
    658	max2175_write(ctx, 8, nco_reg >> 8);
    659	max2175_write(ctx, 9, nco_reg);
    660
    661	return ret;
    662}
    663
    664static int max2175_set_rf_freq_non_am_bands(struct max2175 *ctx, u64 freq,
    665					    u32 lo_pos)
    666{
    667	s64 adj_freq, low_if_freq;
    668	int ret;
    669
    670	mxm_dbg(ctx, "rf_freq: non AM bands\n");
    671
    672	if (MAX2175_IS_FM_MODE(ctx))
    673		low_if_freq = 128000;
    674	else if (MAX2175_IS_FMHD_MODE(ctx))
    675		low_if_freq = 228000;
    676	else
    677		return max2175_set_lo_freq(ctx, freq);
    678
    679	if (MAX2175_IS_BAND_VHF(ctx) == (lo_pos == MAX2175_LO_ABOVE_DESIRED))
    680		adj_freq = freq + low_if_freq;
    681	else
    682		adj_freq = freq - low_if_freq;
    683
    684	ret = max2175_set_lo_freq(ctx, adj_freq);
    685	if (ret)
    686		return ret;
    687
    688	return max2175_set_nco_freq(ctx, -low_if_freq);
    689}
    690
    691static int max2175_set_rf_freq(struct max2175 *ctx, u64 freq, u32 lo_pos)
    692{
    693	int ret;
    694
    695	if (MAX2175_IS_BAND_AM(ctx))
    696		ret = max2175_set_nco_freq(ctx, freq);
    697	else
    698		ret = max2175_set_rf_freq_non_am_bands(ctx, freq, lo_pos);
    699
    700	mxm_dbg(ctx, "set_rf_freq: ret %d freq %llu\n", ret, freq);
    701
    702	return ret;
    703}
    704
    705static int max2175_tune_rf_freq(struct max2175 *ctx, u64 freq, u32 hsls)
    706{
    707	int ret;
    708
    709	ret = max2175_set_rf_freq(ctx, freq, hsls);
    710	if (ret)
    711		return ret;
    712
    713	ret = max2175_csm_action(ctx, MAX2175_BUFFER_PLUS_PRESET_TUNE);
    714	if (ret)
    715		return ret;
    716
    717	mxm_dbg(ctx, "tune_rf_freq: old %u new %llu\n", ctx->freq, freq);
    718	ctx->freq = freq;
    719
    720	return ret;
    721}
    722
    723static void max2175_set_hsls(struct max2175 *ctx, u32 lo_pos)
    724{
    725	mxm_dbg(ctx, "set_hsls: lo_pos %u\n", lo_pos);
    726
    727	if ((lo_pos == MAX2175_LO_BELOW_DESIRED) == MAX2175_IS_BAND_VHF(ctx))
    728		max2175_write_bit(ctx, 5, 4, 1);
    729	else
    730		max2175_write_bit(ctx, 5, 4, 0);
    731}
    732
    733static void max2175_set_eu_rx_mode(struct max2175 *ctx, u32 rx_mode)
    734{
    735	switch (rx_mode) {
    736	case MAX2175_EU_FM_1_2:
    737		max2175_load_fmeu_1p2(ctx);
    738		break;
    739
    740	case MAX2175_DAB_1_2:
    741		max2175_load_dab_1p2(ctx);
    742		break;
    743	}
    744	/* Master is the default setting */
    745	if (!ctx->master)
    746		max2175_write_bit(ctx, 30, 7, 1);
    747}
    748
    749static void max2175_set_na_rx_mode(struct max2175 *ctx, u32 rx_mode)
    750{
    751	switch (rx_mode) {
    752	case MAX2175_NA_FM_1_0:
    753		max2175_load_fmna_1p0(ctx);
    754		break;
    755	case MAX2175_NA_FM_2_0:
    756		max2175_load_fmna_2p0(ctx);
    757		break;
    758	}
    759	/* Master is the default setting */
    760	if (!ctx->master)
    761		max2175_write_bit(ctx, 30, 7, 1);
    762
    763	ctx->decim_ratio = 27;
    764
    765	/* Load the Channel Filter Coefficients into channel filter bank #2 */
    766	max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 0, ch_coeff_fmna);
    767	max2175_set_filter_coeffs(ctx, MAX2175_EQ_MSEL, 0,
    768				  eq_coeff_fmna1_ra02_m6db);
    769}
    770
    771static int max2175_set_rx_mode(struct max2175 *ctx, u32 rx_mode)
    772{
    773	mxm_dbg(ctx, "set_rx_mode: %u am_hiz %u\n", rx_mode, ctx->am_hiz);
    774	if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ)
    775		max2175_set_eu_rx_mode(ctx, rx_mode);
    776	else
    777		max2175_set_na_rx_mode(ctx, rx_mode);
    778
    779	if (ctx->am_hiz) {
    780		mxm_dbg(ctx, "setting AM HiZ related config\n");
    781		max2175_write_bit(ctx, 50, 5, 1);
    782		max2175_write_bit(ctx, 90, 7, 1);
    783		max2175_write_bits(ctx, 73, 1, 0, 2);
    784		max2175_write_bits(ctx, 80, 5, 0, 33);
    785	}
    786
    787	/* Load BB filter trim values saved in ROM */
    788	max2175_set_bbfilter(ctx);
    789
    790	/* Set HSLS */
    791	max2175_set_hsls(ctx, ctx->hsls->cur.val);
    792
    793	/* Use i2s enable settings */
    794	max2175_i2s_enable(ctx, ctx->i2s_en->cur.val);
    795
    796	ctx->mode_resolved = true;
    797
    798	return 0;
    799}
    800
    801static int max2175_rx_mode_from_freq(struct max2175 *ctx, u32 freq, u32 *mode)
    802{
    803	unsigned int i;
    804	int band = max2175_band_from_freq(freq);
    805
    806	/* Pick the first match always */
    807	for (i = 0; i <= ctx->rx_mode->maximum; i++) {
    808		if (ctx->rx_modes[i].band == band) {
    809			*mode = i;
    810			mxm_dbg(ctx, "rx_mode_from_freq: freq %u mode %d\n",
    811				freq, *mode);
    812			return 0;
    813		}
    814	}
    815
    816	return -EINVAL;
    817}
    818
    819static bool max2175_freq_rx_mode_valid(struct max2175 *ctx,
    820					 u32 mode, u32 freq)
    821{
    822	int band = max2175_band_from_freq(freq);
    823
    824	return (ctx->rx_modes[mode].band == band);
    825}
    826
    827static void max2175_load_adc_presets(struct max2175 *ctx)
    828{
    829	unsigned int i, j;
    830
    831	for (i = 0; i < ARRAY_SIZE(adc_presets); i++)
    832		for (j = 0; j < ARRAY_SIZE(adc_presets[0]); j++)
    833			max2175_write(ctx, 146 + j + i * 55, adc_presets[i][j]);
    834}
    835
    836static int max2175_init_power_manager(struct max2175 *ctx)
    837{
    838	int ret;
    839
    840	/* Execute on-chip power-up/calibration */
    841	max2175_write_bit(ctx, 99, 2, 0);
    842	usleep_range(1000, 1500);
    843	max2175_write_bit(ctx, 99, 2, 1);
    844
    845	/* Wait for the power manager to finish. */
    846	ret = max2175_poll_timeout(ctx, 69, 7, 7, 1, 50000);
    847	if (ret)
    848		mxm_err(ctx, "init pm failed\n");
    849
    850	return ret;
    851}
    852
    853static int max2175_recalibrate_adc(struct max2175 *ctx)
    854{
    855	int ret;
    856
    857	/* ADC Re-calibration */
    858	max2175_write(ctx, 150, 0xff);
    859	max2175_write(ctx, 205, 0xff);
    860	max2175_write(ctx, 147, 0x20);
    861	max2175_write(ctx, 147, 0x00);
    862	max2175_write(ctx, 202, 0x20);
    863	max2175_write(ctx, 202, 0x00);
    864
    865	ret = max2175_poll_timeout(ctx, 69, 4, 3, 3, 50000);
    866	if (ret)
    867		mxm_err(ctx, "adc recalibration failed\n");
    868
    869	return ret;
    870}
    871
    872static u8 max2175_read_rom(struct max2175 *ctx, u8 row)
    873{
    874	u8 data = 0;
    875
    876	max2175_write_bit(ctx, 56, 4, 0);
    877	max2175_write_bits(ctx, 56, 3, 0, row);
    878
    879	usleep_range(2000, 2500);
    880	max2175_read(ctx, 58, &data);
    881
    882	max2175_write_bits(ctx, 56, 3, 0, 0);
    883
    884	mxm_dbg(ctx, "read_rom: row %d data 0x%02x\n", row, data);
    885
    886	return data;
    887}
    888
    889static void max2175_load_from_rom(struct max2175 *ctx)
    890{
    891	u8 data = 0;
    892
    893	data = max2175_read_rom(ctx, 0);
    894	ctx->rom_bbf_bw_am = data & 0x0f;
    895	max2175_write_bits(ctx, 81, 3, 0, data >> 4);
    896
    897	data = max2175_read_rom(ctx, 1);
    898	ctx->rom_bbf_bw_fm = data & 0x0f;
    899	ctx->rom_bbf_bw_dab = data >> 4;
    900
    901	data = max2175_read_rom(ctx, 2);
    902	max2175_write_bits(ctx, 82, 4, 0, data & 0x1f);
    903	max2175_write_bits(ctx, 82, 7, 5, data >> 5);
    904
    905	data = max2175_read_rom(ctx, 3);
    906	if (ctx->am_hiz) {
    907		data &= 0x0f;
    908		data |= (max2175_read_rom(ctx, 7) & 0x40) >> 2;
    909		if (!data)
    910			data |= 2;
    911	} else {
    912		data = (data & 0xf0) >> 4;
    913		data |= (max2175_read_rom(ctx, 7) & 0x80) >> 3;
    914		if (!data)
    915			data |= 30;
    916	}
    917	max2175_write_bits(ctx, 80, 5, 0, data + 31);
    918
    919	data = max2175_read_rom(ctx, 6);
    920	max2175_write_bits(ctx, 81, 7, 6, data >> 6);
    921}
    922
    923static void max2175_load_full_fm_eu_1p0(struct max2175 *ctx)
    924{
    925	unsigned int i;
    926
    927	for (i = 0; i < ARRAY_SIZE(full_fm_eu_1p0); i++)
    928		max2175_write(ctx, i + 1, full_fm_eu_1p0[i]);
    929
    930	usleep_range(5000, 5500);
    931	ctx->decim_ratio = 36;
    932}
    933
    934static void max2175_load_full_fm_na_1p0(struct max2175 *ctx)
    935{
    936	unsigned int i;
    937
    938	for (i = 0; i < ARRAY_SIZE(full_fm_na_1p0); i++)
    939		max2175_write(ctx, i + 1, full_fm_na_1p0[i]);
    940
    941	usleep_range(5000, 5500);
    942	ctx->decim_ratio = 27;
    943}
    944
    945static int max2175_core_init(struct max2175 *ctx, u32 refout_bits)
    946{
    947	int ret;
    948
    949	/* MAX2175 uses 36.864MHz clock for EU & 40.154MHz for NA region */
    950	if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ)
    951		max2175_load_full_fm_eu_1p0(ctx);
    952	else
    953		max2175_load_full_fm_na_1p0(ctx);
    954
    955	/* The default settings assume master */
    956	if (!ctx->master)
    957		max2175_write_bit(ctx, 30, 7, 1);
    958
    959	mxm_dbg(ctx, "refout_bits %u\n", refout_bits);
    960
    961	/* Set REFOUT */
    962	max2175_write_bits(ctx, 56, 7, 5, refout_bits);
    963
    964	/* ADC Reset */
    965	max2175_write_bit(ctx, 99, 1, 0);
    966	usleep_range(1000, 1500);
    967	max2175_write_bit(ctx, 99, 1, 1);
    968
    969	/* Load ADC preset values */
    970	max2175_load_adc_presets(ctx);
    971
    972	/* Initialize the power management state machine */
    973	ret = max2175_init_power_manager(ctx);
    974	if (ret)
    975		return ret;
    976
    977	/* Recalibrate ADC */
    978	ret = max2175_recalibrate_adc(ctx);
    979	if (ret)
    980		return ret;
    981
    982	/* Load ROM values to appropriate registers */
    983	max2175_load_from_rom(ctx);
    984
    985	if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ) {
    986		/* Load FIR coefficients into bank 0 */
    987		max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 0,
    988					  ch_coeff_fmeu);
    989		max2175_set_filter_coeffs(ctx, MAX2175_EQ_MSEL, 0,
    990					  eq_coeff_fmeu1_ra02_m6db);
    991	} else {
    992		/* Load FIR coefficients into bank 0 */
    993		max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 0,
    994					  ch_coeff_fmna);
    995		max2175_set_filter_coeffs(ctx, MAX2175_EQ_MSEL, 0,
    996					  eq_coeff_fmna1_ra02_m6db);
    997	}
    998	mxm_dbg(ctx, "core initialized\n");
    999
   1000	return 0;
   1001}
   1002
   1003static void max2175_s_ctrl_rx_mode(struct max2175 *ctx, u32 rx_mode)
   1004{
   1005	/* Load mode. Range check already done */
   1006	max2175_set_rx_mode(ctx, rx_mode);
   1007
   1008	mxm_dbg(ctx, "s_ctrl_rx_mode: %u curr freq %u\n", rx_mode, ctx->freq);
   1009
   1010	/* Check if current freq valid for mode & update */
   1011	if (max2175_freq_rx_mode_valid(ctx, rx_mode, ctx->freq))
   1012		max2175_tune_rf_freq(ctx, ctx->freq, ctx->hsls->cur.val);
   1013	else
   1014		/* Use default freq of mode if current freq is not valid */
   1015		max2175_tune_rf_freq(ctx, ctx->rx_modes[rx_mode].freq,
   1016				     ctx->hsls->cur.val);
   1017}
   1018
   1019static int max2175_s_ctrl(struct v4l2_ctrl *ctrl)
   1020{
   1021	struct max2175 *ctx = max2175_from_ctrl_hdl(ctrl->handler);
   1022
   1023	mxm_dbg(ctx, "s_ctrl: id 0x%x, val %u\n", ctrl->id, ctrl->val);
   1024	switch (ctrl->id) {
   1025	case V4L2_CID_MAX2175_I2S_ENABLE:
   1026		max2175_i2s_enable(ctx, ctrl->val);
   1027		break;
   1028	case V4L2_CID_MAX2175_HSLS:
   1029		max2175_set_hsls(ctx, ctrl->val);
   1030		break;
   1031	case V4L2_CID_MAX2175_RX_MODE:
   1032		max2175_s_ctrl_rx_mode(ctx, ctrl->val);
   1033		break;
   1034	}
   1035
   1036	return 0;
   1037}
   1038
   1039static u32 max2175_get_lna_gain(struct max2175 *ctx)
   1040{
   1041	enum max2175_band band = max2175_read_bits(ctx, 5, 1, 0);
   1042
   1043	switch (band) {
   1044	case MAX2175_BAND_AM:
   1045		return max2175_read_bits(ctx, 51, 3, 0);
   1046	case MAX2175_BAND_FM:
   1047		return max2175_read_bits(ctx, 50, 3, 0);
   1048	case MAX2175_BAND_VHF:
   1049		return max2175_read_bits(ctx, 52, 5, 0);
   1050	default:
   1051		return 0;
   1052	}
   1053}
   1054
   1055static int max2175_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
   1056{
   1057	struct max2175 *ctx = max2175_from_ctrl_hdl(ctrl->handler);
   1058
   1059	switch (ctrl->id) {
   1060	case V4L2_CID_RF_TUNER_LNA_GAIN:
   1061		ctrl->val = max2175_get_lna_gain(ctx);
   1062		break;
   1063	case V4L2_CID_RF_TUNER_IF_GAIN:
   1064		ctrl->val = max2175_read_bits(ctx, 49, 4, 0);
   1065		break;
   1066	case V4L2_CID_RF_TUNER_PLL_LOCK:
   1067		ctrl->val = (max2175_read_bits(ctx, 60, 7, 6) == 3);
   1068		break;
   1069	}
   1070
   1071	return 0;
   1072};
   1073
   1074static int max2175_set_freq_and_mode(struct max2175 *ctx, u32 freq)
   1075{
   1076	u32 rx_mode;
   1077	int ret;
   1078
   1079	/* Get band from frequency */
   1080	ret = max2175_rx_mode_from_freq(ctx, freq, &rx_mode);
   1081	if (ret)
   1082		return ret;
   1083
   1084	mxm_dbg(ctx, "set_freq_and_mode: freq %u rx_mode %d\n", freq, rx_mode);
   1085
   1086	/* Load mode */
   1087	max2175_set_rx_mode(ctx, rx_mode);
   1088	ctx->rx_mode->cur.val = rx_mode;
   1089
   1090	/* Tune to the new freq given */
   1091	return max2175_tune_rf_freq(ctx, freq, ctx->hsls->cur.val);
   1092}
   1093
   1094static int max2175_s_frequency(struct v4l2_subdev *sd,
   1095			       const struct v4l2_frequency *vf)
   1096{
   1097	struct max2175 *ctx = max2175_from_sd(sd);
   1098	u32 freq;
   1099	int ret = 0;
   1100
   1101	mxm_dbg(ctx, "s_freq: new %u curr %u, mode_resolved %d\n",
   1102		vf->frequency, ctx->freq, ctx->mode_resolved);
   1103
   1104	if (vf->tuner != 0)
   1105		return -EINVAL;
   1106
   1107	freq = clamp(vf->frequency, ctx->bands_rf->rangelow,
   1108		     ctx->bands_rf->rangehigh);
   1109
   1110	/* Check new freq valid for rx_mode if already resolved */
   1111	if (ctx->mode_resolved &&
   1112	    max2175_freq_rx_mode_valid(ctx, ctx->rx_mode->cur.val, freq))
   1113		ret = max2175_tune_rf_freq(ctx, freq, ctx->hsls->cur.val);
   1114	else
   1115		/* Find default rx_mode for freq and tune to it */
   1116		ret = max2175_set_freq_and_mode(ctx, freq);
   1117
   1118	mxm_dbg(ctx, "s_freq: ret %d curr %u mode_resolved %d mode %u\n",
   1119		ret, ctx->freq, ctx->mode_resolved, ctx->rx_mode->cur.val);
   1120
   1121	return ret;
   1122}
   1123
   1124static int max2175_g_frequency(struct v4l2_subdev *sd,
   1125			       struct v4l2_frequency *vf)
   1126{
   1127	struct max2175 *ctx = max2175_from_sd(sd);
   1128
   1129	if (vf->tuner != 0)
   1130		return -EINVAL;
   1131
   1132	/* RF freq */
   1133	vf->type = V4L2_TUNER_RF;
   1134	vf->frequency = ctx->freq;
   1135
   1136	return 0;
   1137}
   1138
   1139static int max2175_enum_freq_bands(struct v4l2_subdev *sd,
   1140			    struct v4l2_frequency_band *band)
   1141{
   1142	struct max2175 *ctx = max2175_from_sd(sd);
   1143
   1144	if (band->tuner != 0 || band->index != 0)
   1145		return -EINVAL;
   1146
   1147	*band = *ctx->bands_rf;
   1148
   1149	return 0;
   1150}
   1151
   1152static int max2175_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
   1153{
   1154	struct max2175 *ctx = max2175_from_sd(sd);
   1155
   1156	if (vt->index > 0)
   1157		return -EINVAL;
   1158
   1159	strscpy(vt->name, "RF", sizeof(vt->name));
   1160	vt->type = V4L2_TUNER_RF;
   1161	vt->capability = V4L2_TUNER_CAP_1HZ | V4L2_TUNER_CAP_FREQ_BANDS;
   1162	vt->rangelow = ctx->bands_rf->rangelow;
   1163	vt->rangehigh = ctx->bands_rf->rangehigh;
   1164
   1165	return 0;
   1166}
   1167
   1168static int max2175_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt)
   1169{
   1170	/* Check tuner index is valid */
   1171	if (vt->index > 0)
   1172		return -EINVAL;
   1173
   1174	return 0;
   1175}
   1176
   1177static const struct v4l2_subdev_tuner_ops max2175_tuner_ops = {
   1178	.s_frequency = max2175_s_frequency,
   1179	.g_frequency = max2175_g_frequency,
   1180	.enum_freq_bands = max2175_enum_freq_bands,
   1181	.g_tuner = max2175_g_tuner,
   1182	.s_tuner = max2175_s_tuner,
   1183};
   1184
   1185static const struct v4l2_subdev_ops max2175_ops = {
   1186	.tuner = &max2175_tuner_ops,
   1187};
   1188
   1189static const struct v4l2_ctrl_ops max2175_ctrl_ops = {
   1190	.s_ctrl = max2175_s_ctrl,
   1191	.g_volatile_ctrl = max2175_g_volatile_ctrl,
   1192};
   1193
   1194/*
   1195 * I2S output enable/disable configuration. This is a private control.
   1196 * Refer to Documentation/userspace-api/media/drivers/max2175.rst for more details.
   1197 */
   1198static const struct v4l2_ctrl_config max2175_i2s_en = {
   1199	.ops = &max2175_ctrl_ops,
   1200	.id = V4L2_CID_MAX2175_I2S_ENABLE,
   1201	.name = "I2S Enable",
   1202	.type = V4L2_CTRL_TYPE_BOOLEAN,
   1203	.min = 0,
   1204	.max = 1,
   1205	.step = 1,
   1206	.def = 1,
   1207	.is_private = 1,
   1208};
   1209
   1210/*
   1211 * HSLS value control LO freq adjacent location configuration.
   1212 * Refer to Documentation/userspace-api/media/drivers/max2175.rst for more details.
   1213 */
   1214static const struct v4l2_ctrl_config max2175_hsls = {
   1215	.ops = &max2175_ctrl_ops,
   1216	.id = V4L2_CID_MAX2175_HSLS,
   1217	.name = "HSLS Above/Below Desired",
   1218	.type = V4L2_CTRL_TYPE_BOOLEAN,
   1219	.min = 0,
   1220	.max = 1,
   1221	.step = 1,
   1222	.def = 1,
   1223};
   1224
   1225/*
   1226 * Rx modes below are a set of preset configurations that decides the tuner's
   1227 * sck and sample rate of transmission. They are separate for EU & NA regions.
   1228 * Refer to Documentation/userspace-api/media/drivers/max2175.rst for more details.
   1229 */
   1230static const char * const max2175_ctrl_eu_rx_modes[] = {
   1231	[MAX2175_EU_FM_1_2]	= "EU FM 1.2",
   1232	[MAX2175_DAB_1_2]	= "DAB 1.2",
   1233};
   1234
   1235static const char * const max2175_ctrl_na_rx_modes[] = {
   1236	[MAX2175_NA_FM_1_0]	= "NA FM 1.0",
   1237	[MAX2175_NA_FM_2_0]	= "NA FM 2.0",
   1238};
   1239
   1240static const struct v4l2_ctrl_config max2175_eu_rx_mode = {
   1241	.ops = &max2175_ctrl_ops,
   1242	.id = V4L2_CID_MAX2175_RX_MODE,
   1243	.name = "RX Mode",
   1244	.type = V4L2_CTRL_TYPE_MENU,
   1245	.max = ARRAY_SIZE(max2175_ctrl_eu_rx_modes) - 1,
   1246	.def = 0,
   1247	.qmenu = max2175_ctrl_eu_rx_modes,
   1248};
   1249
   1250static const struct v4l2_ctrl_config max2175_na_rx_mode = {
   1251	.ops = &max2175_ctrl_ops,
   1252	.id = V4L2_CID_MAX2175_RX_MODE,
   1253	.name = "RX Mode",
   1254	.type = V4L2_CTRL_TYPE_MENU,
   1255	.max = ARRAY_SIZE(max2175_ctrl_na_rx_modes) - 1,
   1256	.def = 0,
   1257	.qmenu = max2175_ctrl_na_rx_modes,
   1258};
   1259
   1260static int max2175_refout_load_to_bits(struct i2c_client *client, u32 load,
   1261				       u32 *bits)
   1262{
   1263	if (load <= 40)
   1264		*bits = load / 10;
   1265	else if (load >= 60 && load <= 70)
   1266		*bits = load / 10 - 1;
   1267	else
   1268		return -EINVAL;
   1269
   1270	return 0;
   1271}
   1272
   1273static int max2175_probe(struct i2c_client *client)
   1274{
   1275	bool master = true, am_hiz = false;
   1276	u32 refout_load, refout_bits = 0;	/* REFOUT disabled */
   1277	struct v4l2_ctrl_handler *hdl;
   1278	struct fwnode_handle *fwnode;
   1279	struct device_node *np;
   1280	struct v4l2_subdev *sd;
   1281	struct regmap *regmap;
   1282	struct max2175 *ctx;
   1283	struct clk *clk;
   1284	int ret;
   1285
   1286	/* Parse DT properties */
   1287	np = of_parse_phandle(client->dev.of_node, "maxim,master", 0);
   1288	if (np) {
   1289		master = false;			/* Slave tuner */
   1290		of_node_put(np);
   1291	}
   1292
   1293	fwnode = of_fwnode_handle(client->dev.of_node);
   1294	if (fwnode_property_present(fwnode, "maxim,am-hiz-filter"))
   1295		am_hiz = true;
   1296
   1297	if (!fwnode_property_read_u32(fwnode, "maxim,refout-load",
   1298				      &refout_load)) {
   1299		ret = max2175_refout_load_to_bits(client, refout_load,
   1300						  &refout_bits);
   1301		if (ret) {
   1302			dev_err(&client->dev, "invalid refout_load %u\n",
   1303				refout_load);
   1304			return -EINVAL;
   1305		}
   1306	}
   1307
   1308	clk = devm_clk_get(&client->dev, NULL);
   1309	if (IS_ERR(clk)) {
   1310		ret = PTR_ERR(clk);
   1311		dev_err(&client->dev, "cannot get clock %d\n", ret);
   1312		return ret;
   1313	}
   1314
   1315	regmap = devm_regmap_init_i2c(client, &max2175_regmap_config);
   1316	if (IS_ERR(regmap)) {
   1317		ret = PTR_ERR(regmap);
   1318		dev_err(&client->dev, "regmap init failed %d\n", ret);
   1319		return -ENODEV;
   1320	}
   1321
   1322	/* Alloc tuner context */
   1323	ctx = devm_kzalloc(&client->dev, sizeof(*ctx), GFP_KERNEL);
   1324	if (ctx == NULL)
   1325		return -ENOMEM;
   1326
   1327	sd = &ctx->sd;
   1328	ctx->master = master;
   1329	ctx->am_hiz = am_hiz;
   1330	ctx->mode_resolved = false;
   1331	ctx->regmap = regmap;
   1332	ctx->xtal_freq = clk_get_rate(clk);
   1333	dev_info(&client->dev, "xtal freq %luHz\n", ctx->xtal_freq);
   1334
   1335	v4l2_i2c_subdev_init(sd, client, &max2175_ops);
   1336	ctx->client = client;
   1337
   1338	sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
   1339
   1340	/* Controls */
   1341	hdl = &ctx->ctrl_hdl;
   1342	ret = v4l2_ctrl_handler_init(hdl, 7);
   1343	if (ret)
   1344		return ret;
   1345
   1346	ctx->lna_gain = v4l2_ctrl_new_std(hdl, &max2175_ctrl_ops,
   1347					  V4L2_CID_RF_TUNER_LNA_GAIN,
   1348					  0, 63, 1, 0);
   1349	ctx->lna_gain->flags |= (V4L2_CTRL_FLAG_VOLATILE |
   1350				 V4L2_CTRL_FLAG_READ_ONLY);
   1351	ctx->if_gain = v4l2_ctrl_new_std(hdl, &max2175_ctrl_ops,
   1352					 V4L2_CID_RF_TUNER_IF_GAIN,
   1353					 0, 31, 1, 0);
   1354	ctx->if_gain->flags |= (V4L2_CTRL_FLAG_VOLATILE |
   1355				V4L2_CTRL_FLAG_READ_ONLY);
   1356	ctx->pll_lock = v4l2_ctrl_new_std(hdl, &max2175_ctrl_ops,
   1357					  V4L2_CID_RF_TUNER_PLL_LOCK,
   1358					  0, 1, 1, 0);
   1359	ctx->pll_lock->flags |= (V4L2_CTRL_FLAG_VOLATILE |
   1360				 V4L2_CTRL_FLAG_READ_ONLY);
   1361	ctx->i2s_en = v4l2_ctrl_new_custom(hdl, &max2175_i2s_en, NULL);
   1362	ctx->hsls = v4l2_ctrl_new_custom(hdl, &max2175_hsls, NULL);
   1363
   1364	if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ) {
   1365		ctx->rx_mode = v4l2_ctrl_new_custom(hdl,
   1366						    &max2175_eu_rx_mode, NULL);
   1367		ctx->rx_modes = eu_rx_modes;
   1368		ctx->bands_rf = &eu_bands_rf;
   1369	} else {
   1370		ctx->rx_mode = v4l2_ctrl_new_custom(hdl,
   1371						    &max2175_na_rx_mode, NULL);
   1372		ctx->rx_modes = na_rx_modes;
   1373		ctx->bands_rf = &na_bands_rf;
   1374	}
   1375	ctx->sd.ctrl_handler = &ctx->ctrl_hdl;
   1376
   1377	/* Set the defaults */
   1378	ctx->freq = ctx->bands_rf->rangelow;
   1379
   1380	/* Register subdev */
   1381	ret = v4l2_async_register_subdev(sd);
   1382	if (ret) {
   1383		dev_err(&client->dev, "register subdev failed\n");
   1384		goto err_reg;
   1385	}
   1386
   1387	/* Initialize device */
   1388	ret = max2175_core_init(ctx, refout_bits);
   1389	if (ret)
   1390		goto err_init;
   1391
   1392	ret = v4l2_ctrl_handler_setup(hdl);
   1393	if (ret)
   1394		goto err_init;
   1395
   1396	return 0;
   1397
   1398err_init:
   1399	v4l2_async_unregister_subdev(sd);
   1400err_reg:
   1401	v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
   1402
   1403	return ret;
   1404}
   1405
   1406static int max2175_remove(struct i2c_client *client)
   1407{
   1408	struct v4l2_subdev *sd = i2c_get_clientdata(client);
   1409	struct max2175 *ctx = max2175_from_sd(sd);
   1410
   1411	v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
   1412	v4l2_async_unregister_subdev(sd);
   1413
   1414	return 0;
   1415}
   1416
   1417static const struct i2c_device_id max2175_id[] = {
   1418	{ DRIVER_NAME, 0},
   1419	{},
   1420};
   1421MODULE_DEVICE_TABLE(i2c, max2175_id);
   1422
   1423static const struct of_device_id max2175_of_ids[] = {
   1424	{ .compatible = "maxim,max2175", },
   1425	{ }
   1426};
   1427MODULE_DEVICE_TABLE(of, max2175_of_ids);
   1428
   1429static struct i2c_driver max2175_driver = {
   1430	.driver = {
   1431		.name	= DRIVER_NAME,
   1432		.of_match_table = max2175_of_ids,
   1433	},
   1434	.probe_new	= max2175_probe,
   1435	.remove		= max2175_remove,
   1436	.id_table	= max2175_id,
   1437};
   1438
   1439module_i2c_driver(max2175_driver);
   1440
   1441MODULE_DESCRIPTION("Maxim MAX2175 RF to Bits tuner driver");
   1442MODULE_LICENSE("GPL v2");
   1443MODULE_AUTHOR("Ramesh Shanmugasundaram <ramesh.shanmugasundaram@bp.renesas.com>");