This source file includes following definitions.
- max2175_from_sd
- max2175_from_ctrl_hdl
- max2175_get_bitval
- max2175_read
- max2175_write
- max2175_read_bits
- max2175_write_bits
- max2175_write_bit
- max2175_poll_timeout
- max2175_poll_csm_ready
- max2175_band_from_freq
- max2175_i2s_enable
- max2175_set_filter_coeffs
- max2175_load_fmeu_1p2
- max2175_load_dab_1p2
- max2175_load_fmna_1p0
- max2175_load_fmna_2p0
- max2175_set_bbfilter
- max2175_set_csm_mode
- max2175_csm_action
- max2175_set_lo_freq
- max2175_round_closest
- max2175_set_nco_freq
- max2175_set_rf_freq_non_am_bands
- max2175_set_rf_freq
- max2175_tune_rf_freq
- max2175_set_hsls
- max2175_set_eu_rx_mode
- max2175_set_na_rx_mode
- max2175_set_rx_mode
- max2175_rx_mode_from_freq
- max2175_freq_rx_mode_valid
- max2175_load_adc_presets
- max2175_init_power_manager
- max2175_recalibrate_adc
- max2175_read_rom
- max2175_load_from_rom
- max2175_load_full_fm_eu_1p0
- max2175_load_full_fm_na_1p0
- max2175_core_init
- max2175_s_ctrl_rx_mode
- max2175_s_ctrl
- max2175_get_lna_gain
- max2175_g_volatile_ctrl
- max2175_set_freq_and_mode
- max2175_s_frequency
- max2175_g_frequency
- max2175_enum_freq_bands
- max2175_g_tuner
- max2175_s_tuner
- max2175_refout_load_to_bits
- max2175_probe
- max2175_remove
1
2
3
4
5
6
7
8
9
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
34 struct max2175_rxmode {
35 enum max2175_band band;
36 u32 freq;
37 u8 i2s_word_size;
38 };
39
40
41 struct max2175_reg_map {
42 u8 idx;
43 u8 val;
44 };
45
46 static const struct max2175_rxmode eu_rx_modes[] = {
47
48 [MAX2175_EU_FM_1_2] = { MAX2175_BAND_FM, 98256000, 1 },
49 [MAX2175_DAB_1_2] = { MAX2175_BAND_VHF, 182640000, 0 },
50 };
51
52 static const struct max2175_rxmode na_rx_modes[] = {
53
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
60
61
62 static 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
84 static 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
107 static 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
124 static 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
141 static 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
158 static 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
174 static 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
180 static 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
186 static 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
192 static 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
198 static 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
204 static 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
218 static 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
227 static 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
237 static 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
244 static 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
249 static const struct reg_default max2175_reg_defaults[] = {
250 { 0x00, 0x07},
251 };
252
253 static 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_FLAT,
261 };
262
263 struct max2175 {
264 struct v4l2_subdev sd;
265 struct i2c_client *client;
266
267
268 struct v4l2_ctrl_handler ctrl_hdl;
269 struct v4l2_ctrl *lna_gain;
270 struct v4l2_ctrl *if_gain;
271 struct v4l2_ctrl *pll_lock;
272 struct v4l2_ctrl *i2s_en;
273 struct v4l2_ctrl *hsls;
274 struct v4l2_ctrl *rx_mode;
275
276
277 struct regmap *regmap;
278
279
280 u32 freq;
281 const struct max2175_rxmode *rx_modes;
282 const struct v4l2_frequency_band *bands_rf;
283
284
285 unsigned long xtal_freq;
286 u32 decim_ratio;
287 bool master;
288 bool am_hiz;
289
290
291 u8 rom_bbf_bw_am;
292 u8 rom_bbf_bw_fm;
293 u8 rom_bbf_bw_dab;
294
295
296 bool mode_resolved;
297 };
298
299 static inline struct max2175 *max2175_from_sd(struct v4l2_subdev *sd)
300 {
301 return container_of(sd, struct max2175, sd);
302 }
303
304 static 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
310 static inline u8 max2175_get_bitval(u8 val, u8 msb, u8 lsb)
311 {
312 return (val & GENMASK(msb, lsb)) >> lsb;
313 }
314
315
316 static 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, ®val);
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
330 static 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
342 static 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
352 static 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
364 static 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
370 static 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
380 static 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
406 static 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
416 static void max2175_i2s_enable(struct max2175 *ctx, bool enable)
417 {
418 if (enable)
419
420 max2175_write_bits(ctx, 104, 3, 0, 2);
421 else
422
423 max2175_write_bits(ctx, 104, 3, 0, 9);
424 mxm_dbg(ctx, "i2s %sabled\n", enable ? "en" : "dis");
425 }
426
427 static 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
448 static 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
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
463 static 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
473 max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 2, ch_coeff_dab1);
474 }
475
476 static 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
484 static 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
492 static 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
506 static bool 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
518 switch (new_mode) {
519 case MAX2175_PRESET_TUNE:
520 usleep_range(51100, 51500);
521 break;
522
523
524
525
526 default:
527 break;
528 }
529
530 return max2175_poll_csm_ready(ctx);
531 }
532
533 static 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
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
548 static 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 = div_u64((u64)(lo_freq % ctx->xtal_freq) << 20,
595 ctx->xtal_freq);
596
597
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
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
618
619
620 static 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
628 static 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
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
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
664 static 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
691 static 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
705 static 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
723 static 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
733 static 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
745 if (!ctx->master)
746 max2175_write_bit(ctx, 30, 7, 1);
747 }
748
749 static 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
760 if (!ctx->master)
761 max2175_write_bit(ctx, 30, 7, 1);
762
763 ctx->decim_ratio = 27;
764
765
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
771 static 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
788 max2175_set_bbfilter(ctx);
789
790
791 max2175_set_hsls(ctx, ctx->hsls->cur.val);
792
793
794 max2175_i2s_enable(ctx, ctx->i2s_en->cur.val);
795
796 ctx->mode_resolved = true;
797
798 return 0;
799 }
800
801 static 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
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
819 static 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
827 static 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
836 static int max2175_init_power_manager(struct max2175 *ctx)
837 {
838 int ret;
839
840
841 max2175_write_bit(ctx, 99, 2, 0);
842 usleep_range(1000, 1500);
843 max2175_write_bit(ctx, 99, 2, 1);
844
845
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
853 static int max2175_recalibrate_adc(struct max2175 *ctx)
854 {
855 int ret;
856
857
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
872 static 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
889 static 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
923 static 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
934 static 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
945 static int max2175_core_init(struct max2175 *ctx, u32 refout_bits)
946 {
947 int ret;
948
949
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
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
962 max2175_write_bits(ctx, 56, 7, 5, refout_bits);
963
964
965 max2175_write_bit(ctx, 99, 1, 0);
966 usleep_range(1000, 1500);
967 max2175_write_bit(ctx, 99, 1, 1);
968
969
970 max2175_load_adc_presets(ctx);
971
972
973 ret = max2175_init_power_manager(ctx);
974 if (ret)
975 return ret;
976
977
978 ret = max2175_recalibrate_adc(ctx);
979 if (ret)
980 return ret;
981
982
983 max2175_load_from_rom(ctx);
984
985 if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ) {
986
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
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
1003 static void max2175_s_ctrl_rx_mode(struct max2175 *ctx, u32 rx_mode)
1004 {
1005
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
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
1015 max2175_tune_rf_freq(ctx, ctx->rx_modes[rx_mode].freq,
1016 ctx->hsls->cur.val);
1017 }
1018
1019 static 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
1039 static 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
1055 static 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
1074 static int max2175_set_freq_and_mode(struct max2175 *ctx, u32 freq)
1075 {
1076 u32 rx_mode;
1077 int ret;
1078
1079
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
1087 max2175_set_rx_mode(ctx, rx_mode);
1088 ctx->rx_mode->cur.val = rx_mode;
1089
1090
1091 return max2175_tune_rf_freq(ctx, freq, ctx->hsls->cur.val);
1092 }
1093
1094 static 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
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
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
1124 static int max2175_g_frequency(struct v4l2_subdev *sd,
1125 struct v4l2_frequency *vf)
1126 {
1127 struct max2175 *ctx = max2175_from_sd(sd);
1128 int ret = 0;
1129
1130 if (vf->tuner != 0)
1131 return -EINVAL;
1132
1133
1134 vf->type = V4L2_TUNER_RF;
1135 vf->frequency = ctx->freq;
1136
1137 return ret;
1138 }
1139
1140 static int max2175_enum_freq_bands(struct v4l2_subdev *sd,
1141 struct v4l2_frequency_band *band)
1142 {
1143 struct max2175 *ctx = max2175_from_sd(sd);
1144
1145 if (band->tuner != 0 || band->index != 0)
1146 return -EINVAL;
1147
1148 *band = *ctx->bands_rf;
1149
1150 return 0;
1151 }
1152
1153 static int max2175_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
1154 {
1155 struct max2175 *ctx = max2175_from_sd(sd);
1156
1157 if (vt->index > 0)
1158 return -EINVAL;
1159
1160 strscpy(vt->name, "RF", sizeof(vt->name));
1161 vt->type = V4L2_TUNER_RF;
1162 vt->capability = V4L2_TUNER_CAP_1HZ | V4L2_TUNER_CAP_FREQ_BANDS;
1163 vt->rangelow = ctx->bands_rf->rangelow;
1164 vt->rangehigh = ctx->bands_rf->rangehigh;
1165
1166 return 0;
1167 }
1168
1169 static int max2175_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt)
1170 {
1171
1172 if (vt->index > 0)
1173 return -EINVAL;
1174
1175 return 0;
1176 }
1177
1178 static const struct v4l2_subdev_tuner_ops max2175_tuner_ops = {
1179 .s_frequency = max2175_s_frequency,
1180 .g_frequency = max2175_g_frequency,
1181 .enum_freq_bands = max2175_enum_freq_bands,
1182 .g_tuner = max2175_g_tuner,
1183 .s_tuner = max2175_s_tuner,
1184 };
1185
1186 static const struct v4l2_subdev_ops max2175_ops = {
1187 .tuner = &max2175_tuner_ops,
1188 };
1189
1190 static const struct v4l2_ctrl_ops max2175_ctrl_ops = {
1191 .s_ctrl = max2175_s_ctrl,
1192 .g_volatile_ctrl = max2175_g_volatile_ctrl,
1193 };
1194
1195
1196
1197
1198
1199 static const struct v4l2_ctrl_config max2175_i2s_en = {
1200 .ops = &max2175_ctrl_ops,
1201 .id = V4L2_CID_MAX2175_I2S_ENABLE,
1202 .name = "I2S Enable",
1203 .type = V4L2_CTRL_TYPE_BOOLEAN,
1204 .min = 0,
1205 .max = 1,
1206 .step = 1,
1207 .def = 1,
1208 .is_private = 1,
1209 };
1210
1211
1212
1213
1214
1215 static const struct v4l2_ctrl_config max2175_hsls = {
1216 .ops = &max2175_ctrl_ops,
1217 .id = V4L2_CID_MAX2175_HSLS,
1218 .name = "HSLS Above/Below Desired",
1219 .type = V4L2_CTRL_TYPE_BOOLEAN,
1220 .min = 0,
1221 .max = 1,
1222 .step = 1,
1223 .def = 1,
1224 };
1225
1226
1227
1228
1229
1230
1231 static const char * const max2175_ctrl_eu_rx_modes[] = {
1232 [MAX2175_EU_FM_1_2] = "EU FM 1.2",
1233 [MAX2175_DAB_1_2] = "DAB 1.2",
1234 };
1235
1236 static const char * const max2175_ctrl_na_rx_modes[] = {
1237 [MAX2175_NA_FM_1_0] = "NA FM 1.0",
1238 [MAX2175_NA_FM_2_0] = "NA FM 2.0",
1239 };
1240
1241 static const struct v4l2_ctrl_config max2175_eu_rx_mode = {
1242 .ops = &max2175_ctrl_ops,
1243 .id = V4L2_CID_MAX2175_RX_MODE,
1244 .name = "RX Mode",
1245 .type = V4L2_CTRL_TYPE_MENU,
1246 .max = ARRAY_SIZE(max2175_ctrl_eu_rx_modes) - 1,
1247 .def = 0,
1248 .qmenu = max2175_ctrl_eu_rx_modes,
1249 };
1250
1251 static const struct v4l2_ctrl_config max2175_na_rx_mode = {
1252 .ops = &max2175_ctrl_ops,
1253 .id = V4L2_CID_MAX2175_RX_MODE,
1254 .name = "RX Mode",
1255 .type = V4L2_CTRL_TYPE_MENU,
1256 .max = ARRAY_SIZE(max2175_ctrl_na_rx_modes) - 1,
1257 .def = 0,
1258 .qmenu = max2175_ctrl_na_rx_modes,
1259 };
1260
1261 static int max2175_refout_load_to_bits(struct i2c_client *client, u32 load,
1262 u32 *bits)
1263 {
1264 if (load <= 40)
1265 *bits = load / 10;
1266 else if (load >= 60 && load <= 70)
1267 *bits = load / 10 - 1;
1268 else
1269 return -EINVAL;
1270
1271 return 0;
1272 }
1273
1274 static int max2175_probe(struct i2c_client *client)
1275 {
1276 bool master = true, am_hiz = false;
1277 u32 refout_load, refout_bits = 0;
1278 struct v4l2_ctrl_handler *hdl;
1279 struct fwnode_handle *fwnode;
1280 struct device_node *np;
1281 struct v4l2_subdev *sd;
1282 struct regmap *regmap;
1283 struct max2175 *ctx;
1284 struct clk *clk;
1285 int ret;
1286
1287
1288 np = of_parse_phandle(client->dev.of_node, "maxim,master", 0);
1289 if (np) {
1290 master = false;
1291 of_node_put(np);
1292 }
1293
1294 fwnode = of_fwnode_handle(client->dev.of_node);
1295 if (fwnode_property_present(fwnode, "maxim,am-hiz-filter"))
1296 am_hiz = true;
1297
1298 if (!fwnode_property_read_u32(fwnode, "maxim,refout-load",
1299 &refout_load)) {
1300 ret = max2175_refout_load_to_bits(client, refout_load,
1301 &refout_bits);
1302 if (ret) {
1303 dev_err(&client->dev, "invalid refout_load %u\n",
1304 refout_load);
1305 return -EINVAL;
1306 }
1307 }
1308
1309 clk = devm_clk_get(&client->dev, NULL);
1310 if (IS_ERR(clk)) {
1311 ret = PTR_ERR(clk);
1312 dev_err(&client->dev, "cannot get clock %d\n", ret);
1313 return ret;
1314 }
1315
1316 regmap = devm_regmap_init_i2c(client, &max2175_regmap_config);
1317 if (IS_ERR(regmap)) {
1318 ret = PTR_ERR(regmap);
1319 dev_err(&client->dev, "regmap init failed %d\n", ret);
1320 return -ENODEV;
1321 }
1322
1323
1324 ctx = devm_kzalloc(&client->dev, sizeof(*ctx), GFP_KERNEL);
1325 if (ctx == NULL)
1326 return -ENOMEM;
1327
1328 sd = &ctx->sd;
1329 ctx->master = master;
1330 ctx->am_hiz = am_hiz;
1331 ctx->mode_resolved = false;
1332 ctx->regmap = regmap;
1333 ctx->xtal_freq = clk_get_rate(clk);
1334 dev_info(&client->dev, "xtal freq %luHz\n", ctx->xtal_freq);
1335
1336 v4l2_i2c_subdev_init(sd, client, &max2175_ops);
1337 ctx->client = client;
1338
1339 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
1340
1341
1342 hdl = &ctx->ctrl_hdl;
1343 ret = v4l2_ctrl_handler_init(hdl, 7);
1344 if (ret)
1345 return ret;
1346
1347 ctx->lna_gain = v4l2_ctrl_new_std(hdl, &max2175_ctrl_ops,
1348 V4L2_CID_RF_TUNER_LNA_GAIN,
1349 0, 63, 1, 0);
1350 ctx->lna_gain->flags |= (V4L2_CTRL_FLAG_VOLATILE |
1351 V4L2_CTRL_FLAG_READ_ONLY);
1352 ctx->if_gain = v4l2_ctrl_new_std(hdl, &max2175_ctrl_ops,
1353 V4L2_CID_RF_TUNER_IF_GAIN,
1354 0, 31, 1, 0);
1355 ctx->if_gain->flags |= (V4L2_CTRL_FLAG_VOLATILE |
1356 V4L2_CTRL_FLAG_READ_ONLY);
1357 ctx->pll_lock = v4l2_ctrl_new_std(hdl, &max2175_ctrl_ops,
1358 V4L2_CID_RF_TUNER_PLL_LOCK,
1359 0, 1, 1, 0);
1360 ctx->pll_lock->flags |= (V4L2_CTRL_FLAG_VOLATILE |
1361 V4L2_CTRL_FLAG_READ_ONLY);
1362 ctx->i2s_en = v4l2_ctrl_new_custom(hdl, &max2175_i2s_en, NULL);
1363 ctx->hsls = v4l2_ctrl_new_custom(hdl, &max2175_hsls, NULL);
1364
1365 if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ) {
1366 ctx->rx_mode = v4l2_ctrl_new_custom(hdl,
1367 &max2175_eu_rx_mode, NULL);
1368 ctx->rx_modes = eu_rx_modes;
1369 ctx->bands_rf = &eu_bands_rf;
1370 } else {
1371 ctx->rx_mode = v4l2_ctrl_new_custom(hdl,
1372 &max2175_na_rx_mode, NULL);
1373 ctx->rx_modes = na_rx_modes;
1374 ctx->bands_rf = &na_bands_rf;
1375 }
1376 ctx->sd.ctrl_handler = &ctx->ctrl_hdl;
1377
1378
1379 ctx->freq = ctx->bands_rf->rangelow;
1380
1381
1382 ret = v4l2_async_register_subdev(sd);
1383 if (ret) {
1384 dev_err(&client->dev, "register subdev failed\n");
1385 goto err_reg;
1386 }
1387
1388
1389 ret = max2175_core_init(ctx, refout_bits);
1390 if (ret)
1391 goto err_init;
1392
1393 ret = v4l2_ctrl_handler_setup(hdl);
1394 if (ret)
1395 goto err_init;
1396
1397 return 0;
1398
1399 err_init:
1400 v4l2_async_unregister_subdev(sd);
1401 err_reg:
1402 v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
1403
1404 return ret;
1405 }
1406
1407 static int max2175_remove(struct i2c_client *client)
1408 {
1409 struct v4l2_subdev *sd = i2c_get_clientdata(client);
1410 struct max2175 *ctx = max2175_from_sd(sd);
1411
1412 v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
1413 v4l2_async_unregister_subdev(sd);
1414
1415 return 0;
1416 }
1417
1418 static const struct i2c_device_id max2175_id[] = {
1419 { DRIVER_NAME, 0},
1420 {},
1421 };
1422 MODULE_DEVICE_TABLE(i2c, max2175_id);
1423
1424 static const struct of_device_id max2175_of_ids[] = {
1425 { .compatible = "maxim,max2175", },
1426 { }
1427 };
1428 MODULE_DEVICE_TABLE(of, max2175_of_ids);
1429
1430 static struct i2c_driver max2175_driver = {
1431 .driver = {
1432 .name = DRIVER_NAME,
1433 .of_match_table = max2175_of_ids,
1434 },
1435 .probe_new = max2175_probe,
1436 .remove = max2175_remove,
1437 .id_table = max2175_id,
1438 };
1439
1440 module_i2c_driver(max2175_driver);
1441
1442 MODULE_DESCRIPTION("Maxim MAX2175 RF to Bits tuner driver");
1443 MODULE_LICENSE("GPL v2");
1444 MODULE_AUTHOR("Ramesh Shanmugasundaram <ramesh.shanmugasundaram@bp.renesas.com>");