1 /*
2  * Driver for the MaxLinear MxL5xx family of tuners/demods
3  *
4  * Copyright (C) 2014-2015 Ralph Metzler <rjkm@metzlerbros.de>
5  *                         Marcus Metzler <mocm@metzlerbros.de>
6  *                         developed for Digital Devices GmbH
7  *
8  * based on code:
9  * Copyright (c) 2011-2013 MaxLinear, Inc. All rights reserved
10  * which was released under GPL V2
11  *
12  * This program is free software; you can redistribute it and/or
13  * modify it under the terms of the GNU General Public License
14  * version 2, as published by the Free Software Foundation.
15  *
16  * This program is distributed in the hope that it will be useful,
17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19  * GNU General Public License for more details.
20  *
21  */
22 
23 #include <linux/kernel.h>
24 #include <linux/module.h>
25 #include <linux/moduleparam.h>
26 #include <linux/init.h>
27 #include <linux/delay.h>
28 #include <linux/firmware.h>
29 #include <linux/i2c.h>
30 #include <linux/version.h>
31 #include <linux/mutex.h>
32 #include <linux/vmalloc.h>
33 #include <asm/div64.h>
34 #include <asm/unaligned.h>
35 
36 #include <media/dvb_frontend.h>
37 #include "mxl5xx.h"
38 #include "mxl5xx_regs.h"
39 #include "mxl5xx_defs.h"
40 
41 #define BYTE0(v) ((v >>  0) & 0xff)
42 #define BYTE1(v) ((v >>  8) & 0xff)
43 #define BYTE2(v) ((v >> 16) & 0xff)
44 #define BYTE3(v) ((v >> 24) & 0xff)
45 
46 static LIST_HEAD(mxllist);
47 
48 struct mxl_base {
49 	struct list_head     mxllist;
50 	struct list_head     mxls;
51 
52 	u8                   adr;
53 	struct i2c_adapter  *i2c;
54 
55 	u32                  count;
56 	u32                  type;
57 	u32                  sku_type;
58 	u32                  chipversion;
59 	u32                  clock;
60 	u32                  fwversion;
61 
62 	u8                  *ts_map;
63 	u8                   can_clkout;
64 	u8                   chan_bond;
65 	u8                   demod_num;
66 	u8                   tuner_num;
67 
68 	unsigned long        next_tune;
69 
70 	struct mutex         i2c_lock;
71 	struct mutex         status_lock;
72 	struct mutex         tune_lock;
73 
74 	u8                   buf[MXL_HYDRA_OEM_MAX_CMD_BUFF_LEN];
75 
76 	u32                  cmd_size;
77 	u8                   cmd_data[MAX_CMD_DATA];
78 };
79 
80 struct mxl {
81 	struct list_head     mxl;
82 
83 	struct mxl_base     *base;
84 	struct dvb_frontend  fe;
85 	struct device       *i2cdev;
86 	u32                  demod;
87 	u32                  tuner;
88 	u32                  tuner_in_use;
89 	u8                   xbar[3];
90 
91 	unsigned long        tune_time;
92 };
93 
convert_endian(u8 flag,u32 size,u8 * d)94 static void convert_endian(u8 flag, u32 size, u8 *d)
95 {
96 	u32 i;
97 
98 	if (!flag)
99 		return;
100 	for (i = 0; i < (size & ~3); i += 4) {
101 		d[i + 0] ^= d[i + 3];
102 		d[i + 3] ^= d[i + 0];
103 		d[i + 0] ^= d[i + 3];
104 
105 		d[i + 1] ^= d[i + 2];
106 		d[i + 2] ^= d[i + 1];
107 		d[i + 1] ^= d[i + 2];
108 	}
109 
110 	switch (size & 3) {
111 	case 0:
112 	case 1:
113 		/* do nothing */
114 		break;
115 	case 2:
116 		d[i + 0] ^= d[i + 1];
117 		d[i + 1] ^= d[i + 0];
118 		d[i + 0] ^= d[i + 1];
119 		break;
120 
121 	case 3:
122 		d[i + 0] ^= d[i + 2];
123 		d[i + 2] ^= d[i + 0];
124 		d[i + 0] ^= d[i + 2];
125 		break;
126 	}
127 
128 }
129 
i2c_write(struct i2c_adapter * adap,u8 adr,u8 * data,u32 len)130 static int i2c_write(struct i2c_adapter *adap, u8 adr,
131 			    u8 *data, u32 len)
132 {
133 	struct i2c_msg msg = {.addr = adr, .flags = 0,
134 			      .buf = data, .len = len};
135 
136 	return (i2c_transfer(adap, &msg, 1) == 1) ? 0 : -1;
137 }
138 
i2c_read(struct i2c_adapter * adap,u8 adr,u8 * data,u32 len)139 static int i2c_read(struct i2c_adapter *adap, u8 adr,
140 			   u8 *data, u32 len)
141 {
142 	struct i2c_msg msg = {.addr = adr, .flags = I2C_M_RD,
143 			      .buf = data, .len = len};
144 
145 	return (i2c_transfer(adap, &msg, 1) == 1) ? 0 : -1;
146 }
147 
i2cread(struct mxl * state,u8 * data,int len)148 static int i2cread(struct mxl *state, u8 *data, int len)
149 {
150 	return i2c_read(state->base->i2c, state->base->adr, data, len);
151 }
152 
i2cwrite(struct mxl * state,u8 * data,int len)153 static int i2cwrite(struct mxl *state, u8 *data, int len)
154 {
155 	return i2c_write(state->base->i2c, state->base->adr, data, len);
156 }
157 
read_register_unlocked(struct mxl * state,u32 reg,u32 * val)158 static int read_register_unlocked(struct mxl *state, u32 reg, u32 *val)
159 {
160 	int stat;
161 	u8 data[MXL_HYDRA_REG_SIZE_IN_BYTES + MXL_HYDRA_I2C_HDR_SIZE] = {
162 		MXL_HYDRA_PLID_REG_READ, 0x04,
163 		GET_BYTE(reg, 0), GET_BYTE(reg, 1),
164 		GET_BYTE(reg, 2), GET_BYTE(reg, 3),
165 	};
166 
167 	stat = i2cwrite(state, data,
168 			MXL_HYDRA_REG_SIZE_IN_BYTES + MXL_HYDRA_I2C_HDR_SIZE);
169 	if (stat)
170 		dev_err(state->i2cdev, "i2c read error 1\n");
171 	if (!stat)
172 		stat = i2cread(state, (u8 *) val,
173 			       MXL_HYDRA_REG_SIZE_IN_BYTES);
174 	le32_to_cpus(val);
175 	if (stat)
176 		dev_err(state->i2cdev, "i2c read error 2\n");
177 	return stat;
178 }
179 
180 #define DMA_I2C_INTERRUPT_ADDR 0x8000011C
181 #define DMA_INTR_PROT_WR_CMP 0x08
182 
send_command(struct mxl * state,u32 size,u8 * buf)183 static int send_command(struct mxl *state, u32 size, u8 *buf)
184 {
185 	int stat;
186 	u32 val, count = 10;
187 
188 	mutex_lock(&state->base->i2c_lock);
189 	if (state->base->fwversion > 0x02010109)  {
190 		read_register_unlocked(state, DMA_I2C_INTERRUPT_ADDR, &val);
191 		if (DMA_INTR_PROT_WR_CMP & val)
192 			dev_info(state->i2cdev, "%s busy\n", __func__);
193 		while ((DMA_INTR_PROT_WR_CMP & val) && --count) {
194 			mutex_unlock(&state->base->i2c_lock);
195 			usleep_range(1000, 2000);
196 			mutex_lock(&state->base->i2c_lock);
197 			read_register_unlocked(state, DMA_I2C_INTERRUPT_ADDR,
198 					       &val);
199 		}
200 		if (!count) {
201 			dev_info(state->i2cdev, "%s busy\n", __func__);
202 			mutex_unlock(&state->base->i2c_lock);
203 			return -EBUSY;
204 		}
205 	}
206 	stat = i2cwrite(state, buf, size);
207 	mutex_unlock(&state->base->i2c_lock);
208 	return stat;
209 }
210 
write_register(struct mxl * state,u32 reg,u32 val)211 static int write_register(struct mxl *state, u32 reg, u32 val)
212 {
213 	int stat;
214 	u8 data[MXL_HYDRA_REG_WRITE_LEN] = {
215 		MXL_HYDRA_PLID_REG_WRITE, 0x08,
216 		BYTE0(reg), BYTE1(reg), BYTE2(reg), BYTE3(reg),
217 		BYTE0(val), BYTE1(val), BYTE2(val), BYTE3(val),
218 	};
219 	mutex_lock(&state->base->i2c_lock);
220 	stat = i2cwrite(state, data, sizeof(data));
221 	mutex_unlock(&state->base->i2c_lock);
222 	if (stat)
223 		dev_err(state->i2cdev, "i2c write error\n");
224 	return stat;
225 }
226 
write_firmware_block(struct mxl * state,u32 reg,u32 size,u8 * reg_data_ptr)227 static int write_firmware_block(struct mxl *state,
228 				u32 reg, u32 size, u8 *reg_data_ptr)
229 {
230 	int stat;
231 	u8 *buf = state->base->buf;
232 
233 	mutex_lock(&state->base->i2c_lock);
234 	buf[0] = MXL_HYDRA_PLID_REG_WRITE;
235 	buf[1] = size + 4;
236 	buf[2] = GET_BYTE(reg, 0);
237 	buf[3] = GET_BYTE(reg, 1);
238 	buf[4] = GET_BYTE(reg, 2);
239 	buf[5] = GET_BYTE(reg, 3);
240 	memcpy(&buf[6], reg_data_ptr, size);
241 	stat = i2cwrite(state, buf,
242 			MXL_HYDRA_I2C_HDR_SIZE +
243 			MXL_HYDRA_REG_SIZE_IN_BYTES + size);
244 	mutex_unlock(&state->base->i2c_lock);
245 	if (stat)
246 		dev_err(state->i2cdev, "fw block write failed\n");
247 	return stat;
248 }
249 
read_register(struct mxl * state,u32 reg,u32 * val)250 static int read_register(struct mxl *state, u32 reg, u32 *val)
251 {
252 	int stat;
253 	u8 data[MXL_HYDRA_REG_SIZE_IN_BYTES + MXL_HYDRA_I2C_HDR_SIZE] = {
254 		MXL_HYDRA_PLID_REG_READ, 0x04,
255 		GET_BYTE(reg, 0), GET_BYTE(reg, 1),
256 		GET_BYTE(reg, 2), GET_BYTE(reg, 3),
257 	};
258 
259 	mutex_lock(&state->base->i2c_lock);
260 	stat = i2cwrite(state, data,
261 			MXL_HYDRA_REG_SIZE_IN_BYTES + MXL_HYDRA_I2C_HDR_SIZE);
262 	if (stat)
263 		dev_err(state->i2cdev, "i2c read error 1\n");
264 	if (!stat)
265 		stat = i2cread(state, (u8 *) val,
266 			       MXL_HYDRA_REG_SIZE_IN_BYTES);
267 	mutex_unlock(&state->base->i2c_lock);
268 	le32_to_cpus(val);
269 	if (stat)
270 		dev_err(state->i2cdev, "i2c read error 2\n");
271 	return stat;
272 }
273 
read_register_block(struct mxl * state,u32 reg,u32 size,u8 * data)274 static int read_register_block(struct mxl *state, u32 reg, u32 size, u8 *data)
275 {
276 	int stat;
277 	u8 *buf = state->base->buf;
278 
279 	mutex_lock(&state->base->i2c_lock);
280 
281 	buf[0] = MXL_HYDRA_PLID_REG_READ;
282 	buf[1] = size + 4;
283 	buf[2] = GET_BYTE(reg, 0);
284 	buf[3] = GET_BYTE(reg, 1);
285 	buf[4] = GET_BYTE(reg, 2);
286 	buf[5] = GET_BYTE(reg, 3);
287 	stat = i2cwrite(state, buf,
288 			MXL_HYDRA_I2C_HDR_SIZE + MXL_HYDRA_REG_SIZE_IN_BYTES);
289 	if (!stat) {
290 		stat = i2cread(state, data, size);
291 		convert_endian(MXL_ENABLE_BIG_ENDIAN, size, data);
292 	}
293 	mutex_unlock(&state->base->i2c_lock);
294 	return stat;
295 }
296 
read_by_mnemonic(struct mxl * state,u32 reg,u8 lsbloc,u8 numofbits,u32 * val)297 static int read_by_mnemonic(struct mxl *state,
298 			    u32 reg, u8 lsbloc, u8 numofbits, u32 *val)
299 {
300 	u32 data = 0, mask = 0;
301 	int stat;
302 
303 	stat = read_register(state, reg, &data);
304 	if (stat)
305 		return stat;
306 	mask = MXL_GET_REG_MASK_32(lsbloc, numofbits);
307 	data &= mask;
308 	data >>= lsbloc;
309 	*val = data;
310 	return 0;
311 }
312 
313 
update_by_mnemonic(struct mxl * state,u32 reg,u8 lsbloc,u8 numofbits,u32 val)314 static int update_by_mnemonic(struct mxl *state,
315 			      u32 reg, u8 lsbloc, u8 numofbits, u32 val)
316 {
317 	u32 data, mask;
318 	int stat;
319 
320 	stat = read_register(state, reg, &data);
321 	if (stat)
322 		return stat;
323 	mask = MXL_GET_REG_MASK_32(lsbloc, numofbits);
324 	data = (data & ~mask) | ((val << lsbloc) & mask);
325 	stat = write_register(state, reg, data);
326 	return stat;
327 }
328 
firmware_is_alive(struct mxl * state)329 static int firmware_is_alive(struct mxl *state)
330 {
331 	u32 hb0, hb1;
332 
333 	if (read_register(state, HYDRA_HEAR_BEAT, &hb0))
334 		return 0;
335 	msleep(20);
336 	if (read_register(state, HYDRA_HEAR_BEAT, &hb1))
337 		return 0;
338 	if (hb1 == hb0)
339 		return 0;
340 	return 1;
341 }
342 
init(struct dvb_frontend * fe)343 static int init(struct dvb_frontend *fe)
344 {
345 	struct dtv_frontend_properties *p = &fe->dtv_property_cache;
346 
347 	/* init fe stats */
348 	p->strength.len = 1;
349 	p->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
350 	p->cnr.len = 1;
351 	p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
352 	p->pre_bit_error.len = 1;
353 	p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
354 	p->pre_bit_count.len = 1;
355 	p->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
356 	p->post_bit_error.len = 1;
357 	p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
358 	p->post_bit_count.len = 1;
359 	p->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
360 
361 	return 0;
362 }
363 
release(struct dvb_frontend * fe)364 static void release(struct dvb_frontend *fe)
365 {
366 	struct mxl *state = fe->demodulator_priv;
367 
368 	list_del(&state->mxl);
369 	/* Release one frontend, two more shall take its place! */
370 	state->base->count--;
371 	if (state->base->count == 0) {
372 		list_del(&state->base->mxllist);
373 		kfree(state->base);
374 	}
375 	kfree(state);
376 }
377 
get_algo(struct dvb_frontend * fe)378 static enum dvbfe_algo get_algo(struct dvb_frontend *fe)
379 {
380 	return DVBFE_ALGO_HW;
381 }
382 
gold2root(u32 gold)383 static u32 gold2root(u32 gold)
384 {
385 	u32 x, g, tmp = gold;
386 
387 	if (tmp >= 0x3ffff)
388 		tmp = 0;
389 	for (g = 0, x = 1; g < tmp; g++)
390 		x = (((x ^ (x >> 7)) & 1) << 17) | (x >> 1);
391 	return x;
392 }
393 
cfg_scrambler(struct mxl * state,u32 gold)394 static int cfg_scrambler(struct mxl *state, u32 gold)
395 {
396 	u32 root;
397 	u8 buf[26] = {
398 		MXL_HYDRA_PLID_CMD_WRITE, 24,
399 		0, MXL_HYDRA_DEMOD_SCRAMBLE_CODE_CMD, 0, 0,
400 		state->demod, 0, 0, 0,
401 		0, 0, 0, 0, 0, 0, 0, 0,
402 		0, 0, 0, 0, 1, 0, 0, 0,
403 	};
404 
405 	root = gold2root(gold);
406 
407 	buf[25] = (root >> 24) & 0xff;
408 	buf[24] = (root >> 16) & 0xff;
409 	buf[23] = (root >> 8) & 0xff;
410 	buf[22] = root & 0xff;
411 
412 	return send_command(state, sizeof(buf), buf);
413 }
414 
cfg_demod_abort_tune(struct mxl * state)415 static int cfg_demod_abort_tune(struct mxl *state)
416 {
417 	struct MXL_HYDRA_DEMOD_ABORT_TUNE_T abort_tune_cmd;
418 	u8 cmd_size = sizeof(abort_tune_cmd);
419 	u8 cmd_buff[MXL_HYDRA_OEM_MAX_CMD_BUFF_LEN];
420 
421 	abort_tune_cmd.demod_id = state->demod;
422 	BUILD_HYDRA_CMD(MXL_HYDRA_ABORT_TUNE_CMD, MXL_CMD_WRITE,
423 			cmd_size, &abort_tune_cmd, cmd_buff);
424 	return send_command(state, cmd_size + MXL_HYDRA_CMD_HEADER_SIZE,
425 			    &cmd_buff[0]);
426 }
427 
send_master_cmd(struct dvb_frontend * fe,struct dvb_diseqc_master_cmd * cmd)428 static int send_master_cmd(struct dvb_frontend *fe,
429 			   struct dvb_diseqc_master_cmd *cmd)
430 {
431 	/*struct mxl *state = fe->demodulator_priv;*/
432 
433 	return 0; /*CfgDemodAbortTune(state);*/
434 }
435 
set_parameters(struct dvb_frontend * fe)436 static int set_parameters(struct dvb_frontend *fe)
437 {
438 	struct mxl *state = fe->demodulator_priv;
439 	struct dtv_frontend_properties *p = &fe->dtv_property_cache;
440 	struct MXL_HYDRA_DEMOD_PARAM_T demod_chan_cfg;
441 	u8 cmd_size = sizeof(demod_chan_cfg);
442 	u8 cmd_buff[MXL_HYDRA_OEM_MAX_CMD_BUFF_LEN];
443 	u32 srange = 10;
444 	int stat;
445 
446 	if (p->frequency < 950000 || p->frequency > 2150000)
447 		return -EINVAL;
448 	if (p->symbol_rate < 1000000 || p->symbol_rate > 45000000)
449 		return -EINVAL;
450 
451 	/* CfgDemodAbortTune(state); */
452 
453 	switch (p->delivery_system) {
454 	case SYS_DSS:
455 		demod_chan_cfg.standard = MXL_HYDRA_DSS;
456 		demod_chan_cfg.roll_off = MXL_HYDRA_ROLLOFF_AUTO;
457 		break;
458 	case SYS_DVBS:
459 		srange = p->symbol_rate / 1000000;
460 		if (srange > 10)
461 			srange = 10;
462 		demod_chan_cfg.standard = MXL_HYDRA_DVBS;
463 		demod_chan_cfg.roll_off = MXL_HYDRA_ROLLOFF_0_35;
464 		demod_chan_cfg.modulation_scheme = MXL_HYDRA_MOD_QPSK;
465 		demod_chan_cfg.pilots = MXL_HYDRA_PILOTS_OFF;
466 		break;
467 	case SYS_DVBS2:
468 		demod_chan_cfg.standard = MXL_HYDRA_DVBS2;
469 		demod_chan_cfg.roll_off = MXL_HYDRA_ROLLOFF_AUTO;
470 		demod_chan_cfg.modulation_scheme = MXL_HYDRA_MOD_AUTO;
471 		demod_chan_cfg.pilots = MXL_HYDRA_PILOTS_AUTO;
472 		cfg_scrambler(state, p->scrambling_sequence_index);
473 		break;
474 	default:
475 		return -EINVAL;
476 	}
477 	demod_chan_cfg.tuner_index = state->tuner;
478 	demod_chan_cfg.demod_index = state->demod;
479 	demod_chan_cfg.frequency_in_hz = p->frequency * 1000;
480 	demod_chan_cfg.symbol_rate_in_hz = p->symbol_rate;
481 	demod_chan_cfg.max_carrier_offset_in_mhz = srange;
482 	demod_chan_cfg.spectrum_inversion = MXL_HYDRA_SPECTRUM_AUTO;
483 	demod_chan_cfg.fec_code_rate = MXL_HYDRA_FEC_AUTO;
484 
485 	mutex_lock(&state->base->tune_lock);
486 	if (time_after(jiffies + msecs_to_jiffies(200),
487 		       state->base->next_tune))
488 		while (time_before(jiffies, state->base->next_tune))
489 			usleep_range(10000, 11000);
490 	state->base->next_tune = jiffies + msecs_to_jiffies(100);
491 	state->tuner_in_use = state->tuner;
492 	BUILD_HYDRA_CMD(MXL_HYDRA_DEMOD_SET_PARAM_CMD, MXL_CMD_WRITE,
493 			cmd_size, &demod_chan_cfg, cmd_buff);
494 	stat = send_command(state, cmd_size + MXL_HYDRA_CMD_HEADER_SIZE,
495 			    &cmd_buff[0]);
496 	mutex_unlock(&state->base->tune_lock);
497 	return stat;
498 }
499 
500 static int enable_tuner(struct mxl *state, u32 tuner, u32 enable);
501 
sleep(struct dvb_frontend * fe)502 static int sleep(struct dvb_frontend *fe)
503 {
504 	struct mxl *state = fe->demodulator_priv;
505 	struct mxl *p;
506 
507 	cfg_demod_abort_tune(state);
508 	if (state->tuner_in_use != 0xffffffff) {
509 		mutex_lock(&state->base->tune_lock);
510 		state->tuner_in_use = 0xffffffff;
511 		list_for_each_entry(p, &state->base->mxls, mxl) {
512 			if (p->tuner_in_use == state->tuner)
513 				break;
514 		}
515 		if (&p->mxl == &state->base->mxls)
516 			enable_tuner(state, state->tuner, 0);
517 		mutex_unlock(&state->base->tune_lock);
518 	}
519 	return 0;
520 }
521 
read_snr(struct dvb_frontend * fe)522 static int read_snr(struct dvb_frontend *fe)
523 {
524 	struct mxl *state = fe->demodulator_priv;
525 	int stat;
526 	u32 reg_data = 0;
527 	struct dtv_frontend_properties *p = &fe->dtv_property_cache;
528 
529 	mutex_lock(&state->base->status_lock);
530 	HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
531 	stat = read_register(state, (HYDRA_DMD_SNR_ADDR_OFFSET +
532 				     HYDRA_DMD_STATUS_OFFSET(state->demod)),
533 			     &reg_data);
534 	HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
535 	mutex_unlock(&state->base->status_lock);
536 
537 	p->cnr.stat[0].scale = FE_SCALE_DECIBEL;
538 	p->cnr.stat[0].svalue = (s16)reg_data * 10;
539 
540 	return stat;
541 }
542 
read_ber(struct dvb_frontend * fe)543 static int read_ber(struct dvb_frontend *fe)
544 {
545 	struct mxl *state = fe->demodulator_priv;
546 	struct dtv_frontend_properties *p = &fe->dtv_property_cache;
547 	u32 reg[8];
548 
549 	mutex_lock(&state->base->status_lock);
550 	HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
551 	read_register_block(state,
552 		(HYDRA_DMD_DVBS_1ST_CORR_RS_ERRORS_ADDR_OFFSET +
553 		 HYDRA_DMD_STATUS_OFFSET(state->demod)),
554 		(4 * sizeof(u32)),
555 		(u8 *) &reg[0]);
556 	HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
557 
558 	switch (p->delivery_system) {
559 	case SYS_DSS:
560 	case SYS_DVBS:
561 		p->pre_bit_error.stat[0].scale = FE_SCALE_COUNTER;
562 		p->pre_bit_error.stat[0].uvalue = reg[2];
563 		p->pre_bit_count.stat[0].scale = FE_SCALE_COUNTER;
564 		p->pre_bit_count.stat[0].uvalue = reg[3];
565 		break;
566 	default:
567 		break;
568 	}
569 
570 	read_register_block(state,
571 		(HYDRA_DMD_DVBS2_CRC_ERRORS_ADDR_OFFSET +
572 		 HYDRA_DMD_STATUS_OFFSET(state->demod)),
573 		(7 * sizeof(u32)),
574 		(u8 *) &reg[0]);
575 
576 	switch (p->delivery_system) {
577 	case SYS_DSS:
578 	case SYS_DVBS:
579 		p->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
580 		p->post_bit_error.stat[0].uvalue = reg[5];
581 		p->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
582 		p->post_bit_count.stat[0].uvalue = reg[6];
583 		break;
584 	case SYS_DVBS2:
585 		p->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
586 		p->post_bit_error.stat[0].uvalue = reg[1];
587 		p->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
588 		p->post_bit_count.stat[0].uvalue = reg[2];
589 		break;
590 	default:
591 		break;
592 	}
593 
594 	mutex_unlock(&state->base->status_lock);
595 
596 	return 0;
597 }
598 
read_signal_strength(struct dvb_frontend * fe)599 static int read_signal_strength(struct dvb_frontend *fe)
600 {
601 	struct mxl *state = fe->demodulator_priv;
602 	struct dtv_frontend_properties *p = &fe->dtv_property_cache;
603 	int stat;
604 	u32 reg_data = 0;
605 
606 	mutex_lock(&state->base->status_lock);
607 	HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
608 	stat = read_register(state, (HYDRA_DMD_STATUS_INPUT_POWER_ADDR +
609 				     HYDRA_DMD_STATUS_OFFSET(state->demod)),
610 			     &reg_data);
611 	HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
612 	mutex_unlock(&state->base->status_lock);
613 
614 	p->strength.stat[0].scale = FE_SCALE_DECIBEL;
615 	p->strength.stat[0].svalue = (s16) reg_data * 10; /* fix scale */
616 
617 	return stat;
618 }
619 
read_status(struct dvb_frontend * fe,enum fe_status * status)620 static int read_status(struct dvb_frontend *fe, enum fe_status *status)
621 {
622 	struct mxl *state = fe->demodulator_priv;
623 	struct dtv_frontend_properties *p = &fe->dtv_property_cache;
624 	u32 reg_data = 0;
625 
626 	mutex_lock(&state->base->status_lock);
627 	HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
628 	read_register(state, (HYDRA_DMD_LOCK_STATUS_ADDR_OFFSET +
629 			     HYDRA_DMD_STATUS_OFFSET(state->demod)),
630 			     &reg_data);
631 	HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
632 	mutex_unlock(&state->base->status_lock);
633 
634 	*status = (reg_data == 1) ? 0x1f : 0;
635 
636 	/* signal statistics */
637 
638 	/* signal strength is always available */
639 	read_signal_strength(fe);
640 
641 	if (*status & FE_HAS_CARRIER)
642 		read_snr(fe);
643 	else
644 		p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
645 
646 	if (*status & FE_HAS_SYNC)
647 		read_ber(fe);
648 	else {
649 		p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
650 		p->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
651 		p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
652 		p->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
653 	}
654 
655 	return 0;
656 }
657 
tune(struct dvb_frontend * fe,bool re_tune,unsigned int mode_flags,unsigned int * delay,enum fe_status * status)658 static int tune(struct dvb_frontend *fe, bool re_tune,
659 		unsigned int mode_flags,
660 		unsigned int *delay, enum fe_status *status)
661 {
662 	struct mxl *state = fe->demodulator_priv;
663 	int r = 0;
664 
665 	*delay = HZ / 2;
666 	if (re_tune) {
667 		r = set_parameters(fe);
668 		if (r)
669 			return r;
670 		state->tune_time = jiffies;
671 	}
672 
673 	return read_status(fe, status);
674 }
675 
conv_fec(enum MXL_HYDRA_FEC_E fec)676 static enum fe_code_rate conv_fec(enum MXL_HYDRA_FEC_E fec)
677 {
678 	enum fe_code_rate fec2fec[11] = {
679 		FEC_NONE, FEC_1_2, FEC_3_5, FEC_2_3,
680 		FEC_3_4, FEC_4_5, FEC_5_6, FEC_6_7,
681 		FEC_7_8, FEC_8_9, FEC_9_10
682 	};
683 
684 	if (fec > MXL_HYDRA_FEC_9_10)
685 		return FEC_NONE;
686 	return fec2fec[fec];
687 }
688 
get_frontend(struct dvb_frontend * fe,struct dtv_frontend_properties * p)689 static int get_frontend(struct dvb_frontend *fe,
690 			struct dtv_frontend_properties *p)
691 {
692 	struct mxl *state = fe->demodulator_priv;
693 	u32 reg_data[MXL_DEMOD_CHAN_PARAMS_BUFF_SIZE];
694 	u32 freq;
695 
696 	mutex_lock(&state->base->status_lock);
697 	HYDRA_DEMOD_STATUS_LOCK(state, state->demod);
698 	read_register_block(state,
699 		(HYDRA_DMD_STANDARD_ADDR_OFFSET +
700 		HYDRA_DMD_STATUS_OFFSET(state->demod)),
701 		(MXL_DEMOD_CHAN_PARAMS_BUFF_SIZE * 4), /* 25 * 4 bytes */
702 		(u8 *) &reg_data[0]);
703 	/* read demod channel parameters */
704 	read_register_block(state,
705 		(HYDRA_DMD_STATUS_CENTER_FREQ_IN_KHZ_ADDR +
706 		HYDRA_DMD_STATUS_OFFSET(state->demod)),
707 		(4), /* 4 bytes */
708 		(u8 *) &freq);
709 	HYDRA_DEMOD_STATUS_UNLOCK(state, state->demod);
710 	mutex_unlock(&state->base->status_lock);
711 
712 	dev_dbg(state->i2cdev, "freq=%u delsys=%u srate=%u\n",
713 		freq * 1000, reg_data[DMD_STANDARD_ADDR],
714 		reg_data[DMD_SYMBOL_RATE_ADDR]);
715 	p->symbol_rate = reg_data[DMD_SYMBOL_RATE_ADDR];
716 	p->frequency = freq;
717 	/*
718 	 * p->delivery_system =
719 	 *	(MXL_HYDRA_BCAST_STD_E) regData[DMD_STANDARD_ADDR];
720 	 * p->inversion =
721 	 *	(MXL_HYDRA_SPECTRUM_E) regData[DMD_SPECTRUM_INVERSION_ADDR];
722 	 * freqSearchRangeKHz =
723 	 *	(regData[DMD_FREQ_SEARCH_RANGE_IN_KHZ_ADDR]);
724 	 */
725 
726 	p->fec_inner = conv_fec(reg_data[DMD_FEC_CODE_RATE_ADDR]);
727 	switch (p->delivery_system) {
728 	case SYS_DSS:
729 		break;
730 	case SYS_DVBS2:
731 		switch ((enum MXL_HYDRA_PILOTS_E)
732 			reg_data[DMD_DVBS2_PILOT_ON_OFF_ADDR]) {
733 		case MXL_HYDRA_PILOTS_OFF:
734 			p->pilot = PILOT_OFF;
735 			break;
736 		case MXL_HYDRA_PILOTS_ON:
737 			p->pilot = PILOT_ON;
738 			break;
739 		default:
740 			break;
741 		}
742 	case SYS_DVBS:
743 		switch ((enum MXL_HYDRA_MODULATION_E)
744 			reg_data[DMD_MODULATION_SCHEME_ADDR]) {
745 		case MXL_HYDRA_MOD_QPSK:
746 			p->modulation = QPSK;
747 			break;
748 		case MXL_HYDRA_MOD_8PSK:
749 			p->modulation = PSK_8;
750 			break;
751 		default:
752 			break;
753 		}
754 		switch ((enum MXL_HYDRA_ROLLOFF_E)
755 			reg_data[DMD_SPECTRUM_ROLL_OFF_ADDR]) {
756 		case MXL_HYDRA_ROLLOFF_0_20:
757 			p->rolloff = ROLLOFF_20;
758 			break;
759 		case MXL_HYDRA_ROLLOFF_0_35:
760 			p->rolloff = ROLLOFF_35;
761 			break;
762 		case MXL_HYDRA_ROLLOFF_0_25:
763 			p->rolloff = ROLLOFF_25;
764 			break;
765 		default:
766 			break;
767 		}
768 		break;
769 	default:
770 		return -EINVAL;
771 	}
772 	return 0;
773 }
774 
set_input(struct dvb_frontend * fe,int input)775 static int set_input(struct dvb_frontend *fe, int input)
776 {
777 	struct mxl *state = fe->demodulator_priv;
778 
779 	state->tuner = input;
780 	return 0;
781 }
782 
783 static struct dvb_frontend_ops mxl_ops = {
784 	.delsys = { SYS_DVBS, SYS_DVBS2, SYS_DSS },
785 	.info = {
786 		.name			= "MaxLinear MxL5xx DVB-S/S2 tuner-demodulator",
787 		.frequency_min_hz	=  300 * MHz,
788 		.frequency_max_hz	= 2350 * MHz,
789 		.symbol_rate_min	= 1000000,
790 		.symbol_rate_max	= 45000000,
791 		.caps			= FE_CAN_INVERSION_AUTO |
792 					  FE_CAN_FEC_AUTO       |
793 					  FE_CAN_QPSK           |
794 					  FE_CAN_2G_MODULATION
795 	},
796 	.init				= init,
797 	.release                        = release,
798 	.get_frontend_algo              = get_algo,
799 	.tune                           = tune,
800 	.read_status			= read_status,
801 	.sleep				= sleep,
802 	.get_frontend                   = get_frontend,
803 	.diseqc_send_master_cmd		= send_master_cmd,
804 };
805 
match_base(struct i2c_adapter * i2c,u8 adr)806 static struct mxl_base *match_base(struct i2c_adapter  *i2c, u8 adr)
807 {
808 	struct mxl_base *p;
809 
810 	list_for_each_entry(p, &mxllist, mxllist)
811 		if (p->i2c == i2c && p->adr == adr)
812 			return p;
813 	return NULL;
814 }
815 
cfg_dev_xtal(struct mxl * state,u32 freq,u32 cap,u32 enable)816 static void cfg_dev_xtal(struct mxl *state, u32 freq, u32 cap, u32 enable)
817 {
818 	if (state->base->can_clkout || !enable)
819 		update_by_mnemonic(state, 0x90200054, 23, 1, enable);
820 
821 	if (freq == 24000000)
822 		write_register(state, HYDRA_CRYSTAL_SETTING, 0);
823 	else
824 		write_register(state, HYDRA_CRYSTAL_SETTING, 1);
825 
826 	write_register(state, HYDRA_CRYSTAL_CAP, cap);
827 }
828 
get_big_endian(u8 num_of_bits,const u8 buf[])829 static u32 get_big_endian(u8 num_of_bits, const u8 buf[])
830 {
831 	u32 ret_value = 0;
832 
833 	switch (num_of_bits) {
834 	case 24:
835 		ret_value = (((u32) buf[0]) << 16) |
836 			(((u32) buf[1]) << 8) | buf[2];
837 		break;
838 	case 32:
839 		ret_value = (((u32) buf[0]) << 24) |
840 			(((u32) buf[1]) << 16) |
841 			(((u32) buf[2]) << 8) | buf[3];
842 		break;
843 	default:
844 		break;
845 	}
846 
847 	return ret_value;
848 }
849 
write_fw_segment(struct mxl * state,u32 mem_addr,u32 total_size,u8 * data_ptr)850 static int write_fw_segment(struct mxl *state,
851 			    u32 mem_addr, u32 total_size, u8 *data_ptr)
852 {
853 	int status;
854 	u32 data_count = 0;
855 	u32 size = 0;
856 	u32 orig_size = 0;
857 	u8 *w_buf_ptr = NULL;
858 	u32 block_size = ((MXL_HYDRA_OEM_MAX_BLOCK_WRITE_LENGTH -
859 			 (MXL_HYDRA_I2C_HDR_SIZE +
860 			  MXL_HYDRA_REG_SIZE_IN_BYTES)) / 4) * 4;
861 	u8 w_msg_buffer[MXL_HYDRA_OEM_MAX_BLOCK_WRITE_LENGTH -
862 		      (MXL_HYDRA_I2C_HDR_SIZE + MXL_HYDRA_REG_SIZE_IN_BYTES)];
863 
864 	do {
865 		size = orig_size = (((u32)(data_count + block_size)) > total_size) ?
866 			(total_size - data_count) : block_size;
867 
868 		if (orig_size & 3)
869 			size = (orig_size + 4) & ~3;
870 		w_buf_ptr = &w_msg_buffer[0];
871 		memset((void *) w_buf_ptr, 0, size);
872 		memcpy((void *) w_buf_ptr, (void *) data_ptr, orig_size);
873 		convert_endian(1, size, w_buf_ptr);
874 		status  = write_firmware_block(state, mem_addr, size, w_buf_ptr);
875 		if (status)
876 			return status;
877 		data_count += size;
878 		mem_addr   += size;
879 		data_ptr   += size;
880 	} while (data_count < total_size);
881 
882 	return status;
883 }
884 
do_firmware_download(struct mxl * state,u8 * mbin_buffer_ptr,u32 mbin_buffer_size)885 static int do_firmware_download(struct mxl *state, u8 *mbin_buffer_ptr,
886 				u32 mbin_buffer_size)
887 
888 {
889 	int status;
890 	u32 index = 0;
891 	u32 seg_length = 0;
892 	u32 seg_address = 0;
893 	struct MBIN_FILE_T *mbin_ptr  = (struct MBIN_FILE_T *)mbin_buffer_ptr;
894 	struct MBIN_SEGMENT_T *segment_ptr;
895 	enum MXL_BOOL_E xcpu_fw_flag = MXL_FALSE;
896 
897 	if (mbin_ptr->header.id != MBIN_FILE_HEADER_ID) {
898 		dev_err(state->i2cdev, "%s: Invalid file header ID (%c)\n",
899 		       __func__, mbin_ptr->header.id);
900 		return -EINVAL;
901 	}
902 	status = write_register(state, FW_DL_SIGN_ADDR, 0);
903 	if (status)
904 		return status;
905 	segment_ptr = (struct MBIN_SEGMENT_T *) (&mbin_ptr->data[0]);
906 	for (index = 0; index < mbin_ptr->header.num_segments; index++) {
907 		if (segment_ptr->header.id != MBIN_SEGMENT_HEADER_ID) {
908 			dev_err(state->i2cdev, "%s: Invalid segment header ID (%c)\n",
909 			       __func__, segment_ptr->header.id);
910 			return -EINVAL;
911 		}
912 		seg_length  = get_big_endian(24,
913 					    &(segment_ptr->header.len24[0]));
914 		seg_address = get_big_endian(32,
915 					    &(segment_ptr->header.address[0]));
916 
917 		if (state->base->type == MXL_HYDRA_DEVICE_568) {
918 			if ((((seg_address & 0x90760000) == 0x90760000) ||
919 			     ((seg_address & 0x90740000) == 0x90740000)) &&
920 			    (xcpu_fw_flag == MXL_FALSE)) {
921 				update_by_mnemonic(state, 0x8003003C, 0, 1, 1);
922 				msleep(200);
923 				write_register(state, 0x90720000, 0);
924 				usleep_range(10000, 11000);
925 				xcpu_fw_flag = MXL_TRUE;
926 			}
927 			status = write_fw_segment(state, seg_address,
928 						  seg_length,
929 						  (u8 *) segment_ptr->data);
930 		} else {
931 			if (((seg_address & 0x90760000) != 0x90760000) &&
932 			    ((seg_address & 0x90740000) != 0x90740000))
933 				status = write_fw_segment(state, seg_address,
934 					seg_length, (u8 *) segment_ptr->data);
935 		}
936 		if (status)
937 			return status;
938 		segment_ptr = (struct MBIN_SEGMENT_T *)
939 			&(segment_ptr->data[((seg_length + 3) / 4) * 4]);
940 	}
941 	return status;
942 }
943 
check_fw(struct mxl * state,u8 * mbin,u32 mbin_len)944 static int check_fw(struct mxl *state, u8 *mbin, u32 mbin_len)
945 {
946 	struct MBIN_FILE_HEADER_T *fh = (struct MBIN_FILE_HEADER_T *) mbin;
947 	u32 flen = (fh->image_size24[0] << 16) |
948 		(fh->image_size24[1] <<  8) | fh->image_size24[2];
949 	u8 *fw, cs = 0;
950 	u32 i;
951 
952 	if (fh->id != 'M' || fh->fmt_version != '1' || flen > 0x3FFF0) {
953 		dev_info(state->i2cdev, "Invalid FW Header\n");
954 		return -1;
955 	}
956 	fw = mbin + sizeof(struct MBIN_FILE_HEADER_T);
957 	for (i = 0; i < flen; i += 1)
958 		cs += fw[i];
959 	if (cs != fh->image_checksum) {
960 		dev_info(state->i2cdev, "Invalid FW Checksum\n");
961 		return -1;
962 	}
963 	return 0;
964 }
965 
firmware_download(struct mxl * state,u8 * mbin,u32 mbin_len)966 static int firmware_download(struct mxl *state, u8 *mbin, u32 mbin_len)
967 {
968 	int status;
969 	u32 reg_data = 0;
970 	struct MXL_HYDRA_SKU_COMMAND_T dev_sku_cfg;
971 	u8 cmd_size = sizeof(struct MXL_HYDRA_SKU_COMMAND_T);
972 	u8 cmd_buff[sizeof(struct MXL_HYDRA_SKU_COMMAND_T) + 6];
973 
974 	if (check_fw(state, mbin, mbin_len))
975 		return -1;
976 
977 	/* put CPU into reset */
978 	status = update_by_mnemonic(state, 0x8003003C, 0, 1, 0);
979 	if (status)
980 		return status;
981 	usleep_range(1000, 2000);
982 
983 	/* Reset TX FIFO's, BBAND, XBAR */
984 	status = write_register(state, HYDRA_RESET_TRANSPORT_FIFO_REG,
985 				HYDRA_RESET_TRANSPORT_FIFO_DATA);
986 	if (status)
987 		return status;
988 	status = write_register(state, HYDRA_RESET_BBAND_REG,
989 				HYDRA_RESET_BBAND_DATA);
990 	if (status)
991 		return status;
992 	status = write_register(state, HYDRA_RESET_XBAR_REG,
993 				HYDRA_RESET_XBAR_DATA);
994 	if (status)
995 		return status;
996 
997 	/* Disable clock to Baseband, Wideband, SerDes,
998 	 * Alias ext & Transport modules
999 	 */
1000 	status = write_register(state, HYDRA_MODULES_CLK_2_REG,
1001 				HYDRA_DISABLE_CLK_2);
1002 	if (status)
1003 		return status;
1004 	/* Clear Software & Host interrupt status - (Clear on read) */
1005 	status = read_register(state, HYDRA_PRCM_ROOT_CLK_REG, &reg_data);
1006 	if (status)
1007 		return status;
1008 	status = do_firmware_download(state, mbin, mbin_len);
1009 	if (status)
1010 		return status;
1011 
1012 	if (state->base->type == MXL_HYDRA_DEVICE_568) {
1013 		usleep_range(10000, 11000);
1014 
1015 		/* bring XCPU out of reset */
1016 		status = write_register(state, 0x90720000, 1);
1017 		if (status)
1018 			return status;
1019 		msleep(500);
1020 
1021 		/* Enable XCPU UART message processing in MCPU */
1022 		status = write_register(state, 0x9076B510, 1);
1023 		if (status)
1024 			return status;
1025 	} else {
1026 		/* Bring CPU out of reset */
1027 		status = update_by_mnemonic(state, 0x8003003C, 0, 1, 1);
1028 		if (status)
1029 			return status;
1030 		/* Wait until FW boots */
1031 		msleep(150);
1032 	}
1033 
1034 	/* Initialize XPT XBAR */
1035 	status = write_register(state, XPT_DMD0_BASEADDR, 0x76543210);
1036 	if (status)
1037 		return status;
1038 
1039 	if (!firmware_is_alive(state))
1040 		return -1;
1041 
1042 	dev_info(state->i2cdev, "Hydra FW alive. Hail!\n");
1043 
1044 	/* sometimes register values are wrong shortly
1045 	 * after first heart beats
1046 	 */
1047 	msleep(50);
1048 
1049 	dev_sku_cfg.sku_type = state->base->sku_type;
1050 	BUILD_HYDRA_CMD(MXL_HYDRA_DEV_CFG_SKU_CMD, MXL_CMD_WRITE,
1051 			cmd_size, &dev_sku_cfg, cmd_buff);
1052 	status = send_command(state, cmd_size + MXL_HYDRA_CMD_HEADER_SIZE,
1053 			      &cmd_buff[0]);
1054 
1055 	return status;
1056 }
1057 
cfg_ts_pad_mux(struct mxl * state,enum MXL_BOOL_E enable_serial_ts)1058 static int cfg_ts_pad_mux(struct mxl *state, enum MXL_BOOL_E enable_serial_ts)
1059 {
1060 	int status = 0;
1061 	u32 pad_mux_value = 0;
1062 
1063 	if (enable_serial_ts == MXL_TRUE) {
1064 		pad_mux_value = 0;
1065 		if ((state->base->type == MXL_HYDRA_DEVICE_541) ||
1066 		    (state->base->type == MXL_HYDRA_DEVICE_541S))
1067 			pad_mux_value = 2;
1068 	} else {
1069 		if ((state->base->type == MXL_HYDRA_DEVICE_581) ||
1070 		    (state->base->type == MXL_HYDRA_DEVICE_581S))
1071 			pad_mux_value = 2;
1072 		else
1073 			pad_mux_value = 3;
1074 	}
1075 
1076 	switch (state->base->type) {
1077 	case MXL_HYDRA_DEVICE_561:
1078 	case MXL_HYDRA_DEVICE_581:
1079 	case MXL_HYDRA_DEVICE_541:
1080 	case MXL_HYDRA_DEVICE_541S:
1081 	case MXL_HYDRA_DEVICE_561S:
1082 	case MXL_HYDRA_DEVICE_581S:
1083 		status |= update_by_mnemonic(state, 0x90000170, 24, 3,
1084 					     pad_mux_value);
1085 		status |= update_by_mnemonic(state, 0x90000170, 28, 3,
1086 					     pad_mux_value);
1087 		status |= update_by_mnemonic(state, 0x90000174, 0, 3,
1088 					     pad_mux_value);
1089 		status |= update_by_mnemonic(state, 0x90000174, 4, 3,
1090 					     pad_mux_value);
1091 		status |= update_by_mnemonic(state, 0x90000174, 8, 3,
1092 					     pad_mux_value);
1093 		status |= update_by_mnemonic(state, 0x90000174, 12, 3,
1094 					     pad_mux_value);
1095 		status |= update_by_mnemonic(state, 0x90000174, 16, 3,
1096 					     pad_mux_value);
1097 		status |= update_by_mnemonic(state, 0x90000174, 20, 3,
1098 					     pad_mux_value);
1099 		status |= update_by_mnemonic(state, 0x90000174, 24, 3,
1100 					     pad_mux_value);
1101 		status |= update_by_mnemonic(state, 0x90000174, 28, 3,
1102 					     pad_mux_value);
1103 		status |= update_by_mnemonic(state, 0x90000178, 0, 3,
1104 					     pad_mux_value);
1105 		status |= update_by_mnemonic(state, 0x90000178, 4, 3,
1106 					     pad_mux_value);
1107 		status |= update_by_mnemonic(state, 0x90000178, 8, 3,
1108 					     pad_mux_value);
1109 		break;
1110 
1111 	case MXL_HYDRA_DEVICE_544:
1112 	case MXL_HYDRA_DEVICE_542:
1113 		status |= update_by_mnemonic(state, 0x9000016C, 4, 3, 1);
1114 		status |= update_by_mnemonic(state, 0x9000016C, 8, 3, 0);
1115 		status |= update_by_mnemonic(state, 0x9000016C, 12, 3, 0);
1116 		status |= update_by_mnemonic(state, 0x9000016C, 16, 3, 0);
1117 		status |= update_by_mnemonic(state, 0x90000170, 0, 3, 0);
1118 		status |= update_by_mnemonic(state, 0x90000178, 12, 3, 1);
1119 		status |= update_by_mnemonic(state, 0x90000178, 16, 3, 1);
1120 		status |= update_by_mnemonic(state, 0x90000178, 20, 3, 1);
1121 		status |= update_by_mnemonic(state, 0x90000178, 24, 3, 1);
1122 		status |= update_by_mnemonic(state, 0x9000017C, 0, 3, 1);
1123 		status |= update_by_mnemonic(state, 0x9000017C, 4, 3, 1);
1124 		if (enable_serial_ts == MXL_ENABLE) {
1125 			status |= update_by_mnemonic(state,
1126 				0x90000170, 4, 3, 0);
1127 			status |= update_by_mnemonic(state,
1128 				0x90000170, 8, 3, 0);
1129 			status |= update_by_mnemonic(state,
1130 				0x90000170, 12, 3, 0);
1131 			status |= update_by_mnemonic(state,
1132 				0x90000170, 16, 3, 0);
1133 			status |= update_by_mnemonic(state,
1134 				0x90000170, 20, 3, 1);
1135 			status |= update_by_mnemonic(state,
1136 				0x90000170, 24, 3, 1);
1137 			status |= update_by_mnemonic(state,
1138 				0x90000170, 28, 3, 2);
1139 			status |= update_by_mnemonic(state,
1140 				0x90000174, 0, 3, 2);
1141 			status |= update_by_mnemonic(state,
1142 				0x90000174, 4, 3, 2);
1143 			status |= update_by_mnemonic(state,
1144 				0x90000174, 8, 3, 2);
1145 			status |= update_by_mnemonic(state,
1146 				0x90000174, 12, 3, 2);
1147 			status |= update_by_mnemonic(state,
1148 				0x90000174, 16, 3, 2);
1149 			status |= update_by_mnemonic(state,
1150 				0x90000174, 20, 3, 2);
1151 			status |= update_by_mnemonic(state,
1152 				0x90000174, 24, 3, 2);
1153 			status |= update_by_mnemonic(state,
1154 				0x90000174, 28, 3, 2);
1155 			status |= update_by_mnemonic(state,
1156 				0x90000178, 0, 3, 2);
1157 			status |= update_by_mnemonic(state,
1158 				0x90000178, 4, 3, 2);
1159 			status |= update_by_mnemonic(state,
1160 				0x90000178, 8, 3, 2);
1161 		} else {
1162 			status |= update_by_mnemonic(state,
1163 				0x90000170, 4, 3, 3);
1164 			status |= update_by_mnemonic(state,
1165 				0x90000170, 8, 3, 3);
1166 			status |= update_by_mnemonic(state,
1167 				0x90000170, 12, 3, 3);
1168 			status |= update_by_mnemonic(state,
1169 				0x90000170, 16, 3, 3);
1170 			status |= update_by_mnemonic(state,
1171 				0x90000170, 20, 3, 3);
1172 			status |= update_by_mnemonic(state,
1173 				0x90000170, 24, 3, 3);
1174 			status |= update_by_mnemonic(state,
1175 				0x90000170, 28, 3, 3);
1176 			status |= update_by_mnemonic(state,
1177 				0x90000174, 0, 3, 3);
1178 			status |= update_by_mnemonic(state,
1179 				0x90000174, 4, 3, 3);
1180 			status |= update_by_mnemonic(state,
1181 				0x90000174, 8, 3, 3);
1182 			status |= update_by_mnemonic(state,
1183 				0x90000174, 12, 3, 3);
1184 			status |= update_by_mnemonic(state,
1185 				0x90000174, 16, 3, 3);
1186 			status |= update_by_mnemonic(state,
1187 				0x90000174, 20, 3, 1);
1188 			status |= update_by_mnemonic(state,
1189 				0x90000174, 24, 3, 1);
1190 			status |= update_by_mnemonic(state,
1191 				0x90000174, 28, 3, 1);
1192 			status |= update_by_mnemonic(state,
1193 				0x90000178, 0, 3, 1);
1194 			status |= update_by_mnemonic(state,
1195 				0x90000178, 4, 3, 1);
1196 			status |= update_by_mnemonic(state,
1197 				0x90000178, 8, 3, 1);
1198 		}
1199 		break;
1200 
1201 	case MXL_HYDRA_DEVICE_568:
1202 		if (enable_serial_ts == MXL_FALSE) {
1203 			status |= update_by_mnemonic(state,
1204 				0x9000016C, 8, 3, 5);
1205 			status |= update_by_mnemonic(state,
1206 				0x9000016C, 12, 3, 5);
1207 			status |= update_by_mnemonic(state,
1208 				0x9000016C, 16, 3, 5);
1209 			status |= update_by_mnemonic(state,
1210 				0x9000016C, 20, 3, 5);
1211 			status |= update_by_mnemonic(state,
1212 				0x9000016C, 24, 3, 5);
1213 			status |= update_by_mnemonic(state,
1214 				0x9000016C, 28, 3, 5);
1215 			status |= update_by_mnemonic(state,
1216 				0x90000170, 0, 3, 5);
1217 			status |= update_by_mnemonic(state,
1218 				0x90000170, 4, 3, 5);
1219 			status |= update_by_mnemonic(state,
1220 				0x90000170, 8, 3, 5);
1221 			status |= update_by_mnemonic(state,
1222 				0x90000170, 12, 3, 5);
1223 			status |= update_by_mnemonic(state,
1224 				0x90000170, 16, 3, 5);
1225 			status |= update_by_mnemonic(state,
1226 				0x90000170, 20, 3, 5);
1227 
1228 			status |= update_by_mnemonic(state,
1229 				0x90000170, 24, 3, pad_mux_value);
1230 			status |= update_by_mnemonic(state,
1231 				0x90000174, 0, 3, pad_mux_value);
1232 			status |= update_by_mnemonic(state,
1233 				0x90000174, 4, 3, pad_mux_value);
1234 			status |= update_by_mnemonic(state,
1235 				0x90000174, 8, 3, pad_mux_value);
1236 			status |= update_by_mnemonic(state,
1237 				0x90000174, 12, 3, pad_mux_value);
1238 			status |= update_by_mnemonic(state,
1239 				0x90000174, 16, 3, pad_mux_value);
1240 			status |= update_by_mnemonic(state,
1241 				0x90000174, 20, 3, pad_mux_value);
1242 			status |= update_by_mnemonic(state,
1243 				0x90000174, 24, 3, pad_mux_value);
1244 			status |= update_by_mnemonic(state,
1245 				0x90000174, 28, 3, pad_mux_value);
1246 			status |= update_by_mnemonic(state,
1247 				0x90000178, 0, 3, pad_mux_value);
1248 			status |= update_by_mnemonic(state,
1249 				0x90000178, 4, 3, pad_mux_value);
1250 
1251 			status |= update_by_mnemonic(state,
1252 				0x90000178, 8, 3, 5);
1253 			status |= update_by_mnemonic(state,
1254 				0x90000178, 12, 3, 5);
1255 			status |= update_by_mnemonic(state,
1256 				0x90000178, 16, 3, 5);
1257 			status |= update_by_mnemonic(state,
1258 				0x90000178, 20, 3, 5);
1259 			status |= update_by_mnemonic(state,
1260 				0x90000178, 24, 3, 5);
1261 			status |= update_by_mnemonic(state,
1262 				0x90000178, 28, 3, 5);
1263 			status |= update_by_mnemonic(state,
1264 				0x9000017C, 0, 3, 5);
1265 			status |= update_by_mnemonic(state,
1266 				0x9000017C, 4, 3, 5);
1267 		} else {
1268 			status |= update_by_mnemonic(state,
1269 				0x90000170, 4, 3, pad_mux_value);
1270 			status |= update_by_mnemonic(state,
1271 				0x90000170, 8, 3, pad_mux_value);
1272 			status |= update_by_mnemonic(state,
1273 				0x90000170, 12, 3, pad_mux_value);
1274 			status |= update_by_mnemonic(state,
1275 				0x90000170, 16, 3, pad_mux_value);
1276 			status |= update_by_mnemonic(state,
1277 				0x90000170, 20, 3, pad_mux_value);
1278 			status |= update_by_mnemonic(state,
1279 				0x90000170, 24, 3, pad_mux_value);
1280 			status |= update_by_mnemonic(state,
1281 				0x90000170, 28, 3, pad_mux_value);
1282 			status |= update_by_mnemonic(state,
1283 				0x90000174, 0, 3, pad_mux_value);
1284 			status |= update_by_mnemonic(state,
1285 				0x90000174, 4, 3, pad_mux_value);
1286 			status |= update_by_mnemonic(state,
1287 				0x90000174, 8, 3, pad_mux_value);
1288 			status |= update_by_mnemonic(state,
1289 				0x90000174, 12, 3, pad_mux_value);
1290 		}
1291 		break;
1292 
1293 
1294 	case MXL_HYDRA_DEVICE_584:
1295 	default:
1296 		status |= update_by_mnemonic(state,
1297 			0x90000170, 4, 3, pad_mux_value);
1298 		status |= update_by_mnemonic(state,
1299 			0x90000170, 8, 3, pad_mux_value);
1300 		status |= update_by_mnemonic(state,
1301 			0x90000170, 12, 3, pad_mux_value);
1302 		status |= update_by_mnemonic(state,
1303 			0x90000170, 16, 3, pad_mux_value);
1304 		status |= update_by_mnemonic(state,
1305 			0x90000170, 20, 3, pad_mux_value);
1306 		status |= update_by_mnemonic(state,
1307 			0x90000170, 24, 3, pad_mux_value);
1308 		status |= update_by_mnemonic(state,
1309 			0x90000170, 28, 3, pad_mux_value);
1310 		status |= update_by_mnemonic(state,
1311 			0x90000174, 0, 3, pad_mux_value);
1312 		status |= update_by_mnemonic(state,
1313 			0x90000174, 4, 3, pad_mux_value);
1314 		status |= update_by_mnemonic(state,
1315 			0x90000174, 8, 3, pad_mux_value);
1316 		status |= update_by_mnemonic(state,
1317 			0x90000174, 12, 3, pad_mux_value);
1318 		break;
1319 	}
1320 	return status;
1321 }
1322 
set_drive_strength(struct mxl * state,enum MXL_HYDRA_TS_DRIVE_STRENGTH_E ts_drive_strength)1323 static int set_drive_strength(struct mxl *state,
1324 		enum MXL_HYDRA_TS_DRIVE_STRENGTH_E ts_drive_strength)
1325 {
1326 	int stat = 0;
1327 	u32 val;
1328 
1329 	read_register(state, 0x90000194, &val);
1330 	dev_info(state->i2cdev, "DIGIO = %08x\n", val);
1331 	dev_info(state->i2cdev, "set drive_strength = %u\n", ts_drive_strength);
1332 
1333 
1334 	stat |= update_by_mnemonic(state, 0x90000194, 0, 3, ts_drive_strength);
1335 	stat |= update_by_mnemonic(state, 0x90000194, 20, 3, ts_drive_strength);
1336 	stat |= update_by_mnemonic(state, 0x90000194, 24, 3, ts_drive_strength);
1337 	stat |= update_by_mnemonic(state, 0x90000198, 12, 3, ts_drive_strength);
1338 	stat |= update_by_mnemonic(state, 0x90000198, 16, 3, ts_drive_strength);
1339 	stat |= update_by_mnemonic(state, 0x90000198, 20, 3, ts_drive_strength);
1340 	stat |= update_by_mnemonic(state, 0x90000198, 24, 3, ts_drive_strength);
1341 	stat |= update_by_mnemonic(state, 0x9000019C, 0, 3, ts_drive_strength);
1342 	stat |= update_by_mnemonic(state, 0x9000019C, 4, 3, ts_drive_strength);
1343 	stat |= update_by_mnemonic(state, 0x9000019C, 8, 3, ts_drive_strength);
1344 	stat |= update_by_mnemonic(state, 0x9000019C, 24, 3, ts_drive_strength);
1345 	stat |= update_by_mnemonic(state, 0x9000019C, 28, 3, ts_drive_strength);
1346 	stat |= update_by_mnemonic(state, 0x900001A0, 0, 3, ts_drive_strength);
1347 	stat |= update_by_mnemonic(state, 0x900001A0, 4, 3, ts_drive_strength);
1348 	stat |= update_by_mnemonic(state, 0x900001A0, 20, 3, ts_drive_strength);
1349 	stat |= update_by_mnemonic(state, 0x900001A0, 24, 3, ts_drive_strength);
1350 	stat |= update_by_mnemonic(state, 0x900001A0, 28, 3, ts_drive_strength);
1351 
1352 	return stat;
1353 }
1354 
enable_tuner(struct mxl * state,u32 tuner,u32 enable)1355 static int enable_tuner(struct mxl *state, u32 tuner, u32 enable)
1356 {
1357 	int stat = 0;
1358 	struct MXL_HYDRA_TUNER_CMD ctrl_tuner_cmd;
1359 	u8 cmd_size = sizeof(ctrl_tuner_cmd);
1360 	u8 cmd_buff[MXL_HYDRA_OEM_MAX_CMD_BUFF_LEN];
1361 	u32 val, count = 10;
1362 
1363 	ctrl_tuner_cmd.tuner_id = tuner;
1364 	ctrl_tuner_cmd.enable = enable;
1365 	BUILD_HYDRA_CMD(MXL_HYDRA_TUNER_ACTIVATE_CMD, MXL_CMD_WRITE,
1366 			cmd_size, &ctrl_tuner_cmd, cmd_buff);
1367 	stat = send_command(state, cmd_size + MXL_HYDRA_CMD_HEADER_SIZE,
1368 			    &cmd_buff[0]);
1369 	if (stat)
1370 		return stat;
1371 	read_register(state, HYDRA_TUNER_ENABLE_COMPLETE, &val);
1372 	while (--count && ((val >> tuner) & 1) != enable) {
1373 		msleep(20);
1374 		read_register(state, HYDRA_TUNER_ENABLE_COMPLETE, &val);
1375 	}
1376 	if (!count)
1377 		return -1;
1378 	read_register(state, HYDRA_TUNER_ENABLE_COMPLETE, &val);
1379 	dev_dbg(state->i2cdev, "tuner %u ready = %u\n",
1380 		tuner, (val >> tuner) & 1);
1381 
1382 	return 0;
1383 }
1384 
1385 
config_ts(struct mxl * state,enum MXL_HYDRA_DEMOD_ID_E demod_id,struct MXL_HYDRA_MPEGOUT_PARAM_T * mpeg_out_param_ptr)1386 static int config_ts(struct mxl *state, enum MXL_HYDRA_DEMOD_ID_E demod_id,
1387 		     struct MXL_HYDRA_MPEGOUT_PARAM_T *mpeg_out_param_ptr)
1388 {
1389 	int status = 0;
1390 	u32 nco_count_min = 0;
1391 	u32 clk_type = 0;
1392 
1393 	struct MXL_REG_FIELD_T xpt_sync_polarity[MXL_HYDRA_DEMOD_MAX] = {
1394 		{0x90700010, 8, 1}, {0x90700010, 9, 1},
1395 		{0x90700010, 10, 1}, {0x90700010, 11, 1},
1396 		{0x90700010, 12, 1}, {0x90700010, 13, 1},
1397 		{0x90700010, 14, 1}, {0x90700010, 15, 1} };
1398 	struct MXL_REG_FIELD_T xpt_clock_polarity[MXL_HYDRA_DEMOD_MAX] = {
1399 		{0x90700010, 16, 1}, {0x90700010, 17, 1},
1400 		{0x90700010, 18, 1}, {0x90700010, 19, 1},
1401 		{0x90700010, 20, 1}, {0x90700010, 21, 1},
1402 		{0x90700010, 22, 1}, {0x90700010, 23, 1} };
1403 	struct MXL_REG_FIELD_T xpt_valid_polarity[MXL_HYDRA_DEMOD_MAX] = {
1404 		{0x90700014, 0, 1}, {0x90700014, 1, 1},
1405 		{0x90700014, 2, 1}, {0x90700014, 3, 1},
1406 		{0x90700014, 4, 1}, {0x90700014, 5, 1},
1407 		{0x90700014, 6, 1}, {0x90700014, 7, 1} };
1408 	struct MXL_REG_FIELD_T xpt_ts_clock_phase[MXL_HYDRA_DEMOD_MAX] = {
1409 		{0x90700018, 0, 3}, {0x90700018, 4, 3},
1410 		{0x90700018, 8, 3}, {0x90700018, 12, 3},
1411 		{0x90700018, 16, 3}, {0x90700018, 20, 3},
1412 		{0x90700018, 24, 3}, {0x90700018, 28, 3} };
1413 	struct MXL_REG_FIELD_T xpt_lsb_first[MXL_HYDRA_DEMOD_MAX] = {
1414 		{0x9070000C, 16, 1}, {0x9070000C, 17, 1},
1415 		{0x9070000C, 18, 1}, {0x9070000C, 19, 1},
1416 		{0x9070000C, 20, 1}, {0x9070000C, 21, 1},
1417 		{0x9070000C, 22, 1}, {0x9070000C, 23, 1} };
1418 	struct MXL_REG_FIELD_T xpt_sync_byte[MXL_HYDRA_DEMOD_MAX] = {
1419 		{0x90700010, 0, 1}, {0x90700010, 1, 1},
1420 		{0x90700010, 2, 1}, {0x90700010, 3, 1},
1421 		{0x90700010, 4, 1}, {0x90700010, 5, 1},
1422 		{0x90700010, 6, 1}, {0x90700010, 7, 1} };
1423 	struct MXL_REG_FIELD_T xpt_enable_output[MXL_HYDRA_DEMOD_MAX] = {
1424 		{0x9070000C, 0, 1}, {0x9070000C, 1, 1},
1425 		{0x9070000C, 2, 1}, {0x9070000C, 3, 1},
1426 		{0x9070000C, 4, 1}, {0x9070000C, 5, 1},
1427 		{0x9070000C, 6, 1}, {0x9070000C, 7, 1} };
1428 	struct MXL_REG_FIELD_T xpt_err_replace_sync[MXL_HYDRA_DEMOD_MAX] = {
1429 		{0x9070000C, 24, 1}, {0x9070000C, 25, 1},
1430 		{0x9070000C, 26, 1}, {0x9070000C, 27, 1},
1431 		{0x9070000C, 28, 1}, {0x9070000C, 29, 1},
1432 		{0x9070000C, 30, 1}, {0x9070000C, 31, 1} };
1433 	struct MXL_REG_FIELD_T xpt_err_replace_valid[MXL_HYDRA_DEMOD_MAX] = {
1434 		{0x90700014, 8, 1}, {0x90700014, 9, 1},
1435 		{0x90700014, 10, 1}, {0x90700014, 11, 1},
1436 		{0x90700014, 12, 1}, {0x90700014, 13, 1},
1437 		{0x90700014, 14, 1}, {0x90700014, 15, 1} };
1438 	struct MXL_REG_FIELD_T xpt_continuous_clock[MXL_HYDRA_DEMOD_MAX] = {
1439 		{0x907001D4, 0, 1}, {0x907001D4, 1, 1},
1440 		{0x907001D4, 2, 1}, {0x907001D4, 3, 1},
1441 		{0x907001D4, 4, 1}, {0x907001D4, 5, 1},
1442 		{0x907001D4, 6, 1}, {0x907001D4, 7, 1} };
1443 	struct MXL_REG_FIELD_T xpt_nco_clock_rate[MXL_HYDRA_DEMOD_MAX] = {
1444 		{0x90700044, 16, 80}, {0x90700044, 16, 81},
1445 		{0x90700044, 16, 82}, {0x90700044, 16, 83},
1446 		{0x90700044, 16, 84}, {0x90700044, 16, 85},
1447 		{0x90700044, 16, 86}, {0x90700044, 16, 87} };
1448 
1449 	demod_id = state->base->ts_map[demod_id];
1450 
1451 	if (mpeg_out_param_ptr->enable == MXL_ENABLE) {
1452 		if (mpeg_out_param_ptr->mpeg_mode ==
1453 		    MXL_HYDRA_MPEG_MODE_PARALLEL) {
1454 		} else {
1455 			cfg_ts_pad_mux(state, MXL_TRUE);
1456 			update_by_mnemonic(state,
1457 				0x90700010, 27, 1, MXL_FALSE);
1458 		}
1459 	}
1460 
1461 	nco_count_min =
1462 		(u32)(MXL_HYDRA_NCO_CLK / mpeg_out_param_ptr->max_mpeg_clk_rate);
1463 
1464 	if (state->base->chipversion >= 2) {
1465 		status |= update_by_mnemonic(state,
1466 			xpt_nco_clock_rate[demod_id].reg_addr, /* Reg Addr */
1467 			xpt_nco_clock_rate[demod_id].lsb_pos, /* LSB pos */
1468 			xpt_nco_clock_rate[demod_id].num_of_bits, /* Num of bits */
1469 			nco_count_min); /* Data */
1470 	} else
1471 		update_by_mnemonic(state, 0x90700044, 16, 8, nco_count_min);
1472 
1473 	if (mpeg_out_param_ptr->mpeg_clk_type == MXL_HYDRA_MPEG_CLK_CONTINUOUS)
1474 		clk_type = 1;
1475 
1476 	if (mpeg_out_param_ptr->mpeg_mode < MXL_HYDRA_MPEG_MODE_PARALLEL) {
1477 		status |= update_by_mnemonic(state,
1478 			xpt_continuous_clock[demod_id].reg_addr,
1479 			xpt_continuous_clock[demod_id].lsb_pos,
1480 			xpt_continuous_clock[demod_id].num_of_bits,
1481 			clk_type);
1482 	} else
1483 		update_by_mnemonic(state, 0x907001D4, 8, 1, clk_type);
1484 
1485 	status |= update_by_mnemonic(state,
1486 		xpt_sync_polarity[demod_id].reg_addr,
1487 		xpt_sync_polarity[demod_id].lsb_pos,
1488 		xpt_sync_polarity[demod_id].num_of_bits,
1489 		mpeg_out_param_ptr->mpeg_sync_pol);
1490 
1491 	status |= update_by_mnemonic(state,
1492 		xpt_valid_polarity[demod_id].reg_addr,
1493 		xpt_valid_polarity[demod_id].lsb_pos,
1494 		xpt_valid_polarity[demod_id].num_of_bits,
1495 		mpeg_out_param_ptr->mpeg_valid_pol);
1496 
1497 	status |= update_by_mnemonic(state,
1498 		xpt_clock_polarity[demod_id].reg_addr,
1499 		xpt_clock_polarity[demod_id].lsb_pos,
1500 		xpt_clock_polarity[demod_id].num_of_bits,
1501 		mpeg_out_param_ptr->mpeg_clk_pol);
1502 
1503 	status |= update_by_mnemonic(state,
1504 		xpt_sync_byte[demod_id].reg_addr,
1505 		xpt_sync_byte[demod_id].lsb_pos,
1506 		xpt_sync_byte[demod_id].num_of_bits,
1507 		mpeg_out_param_ptr->mpeg_sync_pulse_width);
1508 
1509 	status |= update_by_mnemonic(state,
1510 		xpt_ts_clock_phase[demod_id].reg_addr,
1511 		xpt_ts_clock_phase[demod_id].lsb_pos,
1512 		xpt_ts_clock_phase[demod_id].num_of_bits,
1513 		mpeg_out_param_ptr->mpeg_clk_phase);
1514 
1515 	status |= update_by_mnemonic(state,
1516 		xpt_lsb_first[demod_id].reg_addr,
1517 		xpt_lsb_first[demod_id].lsb_pos,
1518 		xpt_lsb_first[demod_id].num_of_bits,
1519 		mpeg_out_param_ptr->lsb_or_msb_first);
1520 
1521 	switch (mpeg_out_param_ptr->mpeg_error_indication) {
1522 	case MXL_HYDRA_MPEG_ERR_REPLACE_SYNC:
1523 		status |= update_by_mnemonic(state,
1524 			xpt_err_replace_sync[demod_id].reg_addr,
1525 			xpt_err_replace_sync[demod_id].lsb_pos,
1526 			xpt_err_replace_sync[demod_id].num_of_bits,
1527 			MXL_TRUE);
1528 		status |= update_by_mnemonic(state,
1529 			xpt_err_replace_valid[demod_id].reg_addr,
1530 			xpt_err_replace_valid[demod_id].lsb_pos,
1531 			xpt_err_replace_valid[demod_id].num_of_bits,
1532 			MXL_FALSE);
1533 		break;
1534 
1535 	case MXL_HYDRA_MPEG_ERR_REPLACE_VALID:
1536 		status |= update_by_mnemonic(state,
1537 			xpt_err_replace_sync[demod_id].reg_addr,
1538 			xpt_err_replace_sync[demod_id].lsb_pos,
1539 			xpt_err_replace_sync[demod_id].num_of_bits,
1540 			MXL_FALSE);
1541 
1542 		status |= update_by_mnemonic(state,
1543 			xpt_err_replace_valid[demod_id].reg_addr,
1544 			xpt_err_replace_valid[demod_id].lsb_pos,
1545 			xpt_err_replace_valid[demod_id].num_of_bits,
1546 			MXL_TRUE);
1547 		break;
1548 
1549 	case MXL_HYDRA_MPEG_ERR_INDICATION_DISABLED:
1550 	default:
1551 		status |= update_by_mnemonic(state,
1552 			xpt_err_replace_sync[demod_id].reg_addr,
1553 			xpt_err_replace_sync[demod_id].lsb_pos,
1554 			xpt_err_replace_sync[demod_id].num_of_bits,
1555 			MXL_FALSE);
1556 
1557 		status |= update_by_mnemonic(state,
1558 			xpt_err_replace_valid[demod_id].reg_addr,
1559 			xpt_err_replace_valid[demod_id].lsb_pos,
1560 			xpt_err_replace_valid[demod_id].num_of_bits,
1561 			MXL_FALSE);
1562 
1563 		break;
1564 
1565 	}
1566 
1567 	if (mpeg_out_param_ptr->mpeg_mode != MXL_HYDRA_MPEG_MODE_PARALLEL) {
1568 		status |= update_by_mnemonic(state,
1569 			xpt_enable_output[demod_id].reg_addr,
1570 			xpt_enable_output[demod_id].lsb_pos,
1571 			xpt_enable_output[demod_id].num_of_bits,
1572 			mpeg_out_param_ptr->enable);
1573 	}
1574 	return status;
1575 }
1576 
config_mux(struct mxl * state)1577 static int config_mux(struct mxl *state)
1578 {
1579 	update_by_mnemonic(state, 0x9070000C, 0, 1, 0);
1580 	update_by_mnemonic(state, 0x9070000C, 1, 1, 0);
1581 	update_by_mnemonic(state, 0x9070000C, 2, 1, 0);
1582 	update_by_mnemonic(state, 0x9070000C, 3, 1, 0);
1583 	update_by_mnemonic(state, 0x9070000C, 4, 1, 0);
1584 	update_by_mnemonic(state, 0x9070000C, 5, 1, 0);
1585 	update_by_mnemonic(state, 0x9070000C, 6, 1, 0);
1586 	update_by_mnemonic(state, 0x9070000C, 7, 1, 0);
1587 	update_by_mnemonic(state, 0x90700008, 0, 2, 1);
1588 	update_by_mnemonic(state, 0x90700008, 2, 2, 1);
1589 	return 0;
1590 }
1591 
load_fw(struct mxl * state,struct mxl5xx_cfg * cfg)1592 static int load_fw(struct mxl *state, struct mxl5xx_cfg *cfg)
1593 {
1594 	int stat = 0;
1595 	u8 *buf;
1596 
1597 	if (cfg->fw)
1598 		return firmware_download(state, cfg->fw, cfg->fw_len);
1599 
1600 	if (!cfg->fw_read)
1601 		return -1;
1602 
1603 	buf = vmalloc(0x40000);
1604 	if (!buf)
1605 		return -ENOMEM;
1606 
1607 	cfg->fw_read(cfg->fw_priv, buf, 0x40000);
1608 	stat = firmware_download(state, buf, 0x40000);
1609 	vfree(buf);
1610 
1611 	return stat;
1612 }
1613 
validate_sku(struct mxl * state)1614 static int validate_sku(struct mxl *state)
1615 {
1616 	u32 pad_mux_bond = 0, prcm_chip_id = 0, prcm_so_cid = 0;
1617 	int status;
1618 	u32 type = state->base->type;
1619 
1620 	status = read_by_mnemonic(state, 0x90000190, 0, 3, &pad_mux_bond);
1621 	status |= read_by_mnemonic(state, 0x80030000, 0, 12, &prcm_chip_id);
1622 	status |= read_by_mnemonic(state, 0x80030004, 24, 8, &prcm_so_cid);
1623 	if (status)
1624 		return -1;
1625 
1626 	dev_info(state->i2cdev, "padMuxBond=%08x, prcmChipId=%08x, prcmSoCId=%08x\n",
1627 		pad_mux_bond, prcm_chip_id, prcm_so_cid);
1628 
1629 	if (prcm_chip_id != 0x560) {
1630 		switch (pad_mux_bond) {
1631 		case MXL_HYDRA_SKU_ID_581:
1632 			if (type == MXL_HYDRA_DEVICE_581)
1633 				return 0;
1634 			if (type == MXL_HYDRA_DEVICE_581S) {
1635 				state->base->type = MXL_HYDRA_DEVICE_581;
1636 				return 0;
1637 			}
1638 			break;
1639 		case MXL_HYDRA_SKU_ID_584:
1640 			if (type == MXL_HYDRA_DEVICE_584)
1641 				return 0;
1642 			break;
1643 		case MXL_HYDRA_SKU_ID_544:
1644 			if (type == MXL_HYDRA_DEVICE_544)
1645 				return 0;
1646 			if (type == MXL_HYDRA_DEVICE_542)
1647 				return 0;
1648 			break;
1649 		case MXL_HYDRA_SKU_ID_582:
1650 			if (type == MXL_HYDRA_DEVICE_582)
1651 				return 0;
1652 			break;
1653 		default:
1654 			return -1;
1655 		}
1656 	} else {
1657 
1658 	}
1659 	return -1;
1660 }
1661 
get_fwinfo(struct mxl * state)1662 static int get_fwinfo(struct mxl *state)
1663 {
1664 	int status;
1665 	u32 val = 0;
1666 
1667 	status = read_by_mnemonic(state, 0x90000190, 0, 3, &val);
1668 	if (status)
1669 		return status;
1670 	dev_info(state->i2cdev, "chipID=%08x\n", val);
1671 
1672 	status = read_by_mnemonic(state, 0x80030004, 8, 8, &val);
1673 	if (status)
1674 		return status;
1675 	dev_info(state->i2cdev, "chipVer=%08x\n", val);
1676 
1677 	status = read_register(state, HYDRA_FIRMWARE_VERSION, &val);
1678 	if (status)
1679 		return status;
1680 	dev_info(state->i2cdev, "FWVer=%08x\n", val);
1681 
1682 	state->base->fwversion = val;
1683 	return status;
1684 }
1685 
1686 
1687 static u8 ts_map1_to_1[MXL_HYDRA_DEMOD_MAX] = {
1688 	MXL_HYDRA_DEMOD_ID_0,
1689 	MXL_HYDRA_DEMOD_ID_1,
1690 	MXL_HYDRA_DEMOD_ID_2,
1691 	MXL_HYDRA_DEMOD_ID_3,
1692 	MXL_HYDRA_DEMOD_ID_4,
1693 	MXL_HYDRA_DEMOD_ID_5,
1694 	MXL_HYDRA_DEMOD_ID_6,
1695 	MXL_HYDRA_DEMOD_ID_7,
1696 };
1697 
1698 static u8 ts_map54x[MXL_HYDRA_DEMOD_MAX] = {
1699 	MXL_HYDRA_DEMOD_ID_2,
1700 	MXL_HYDRA_DEMOD_ID_3,
1701 	MXL_HYDRA_DEMOD_ID_4,
1702 	MXL_HYDRA_DEMOD_ID_5,
1703 	MXL_HYDRA_DEMOD_MAX,
1704 	MXL_HYDRA_DEMOD_MAX,
1705 	MXL_HYDRA_DEMOD_MAX,
1706 	MXL_HYDRA_DEMOD_MAX,
1707 };
1708 
probe(struct mxl * state,struct mxl5xx_cfg * cfg)1709 static int probe(struct mxl *state, struct mxl5xx_cfg *cfg)
1710 {
1711 	u32 chipver;
1712 	int fw, status, j;
1713 	struct MXL_HYDRA_MPEGOUT_PARAM_T mpeg_interface_cfg;
1714 
1715 	state->base->ts_map = ts_map1_to_1;
1716 
1717 	switch (state->base->type) {
1718 	case MXL_HYDRA_DEVICE_581:
1719 	case MXL_HYDRA_DEVICE_581S:
1720 		state->base->can_clkout = 1;
1721 		state->base->demod_num = 8;
1722 		state->base->tuner_num = 1;
1723 		state->base->sku_type = MXL_HYDRA_SKU_TYPE_581;
1724 		break;
1725 	case MXL_HYDRA_DEVICE_582:
1726 		state->base->can_clkout = 1;
1727 		state->base->demod_num = 8;
1728 		state->base->tuner_num = 3;
1729 		state->base->sku_type = MXL_HYDRA_SKU_TYPE_582;
1730 		break;
1731 	case MXL_HYDRA_DEVICE_585:
1732 		state->base->can_clkout = 0;
1733 		state->base->demod_num = 8;
1734 		state->base->tuner_num = 4;
1735 		state->base->sku_type = MXL_HYDRA_SKU_TYPE_585;
1736 		break;
1737 	case MXL_HYDRA_DEVICE_544:
1738 		state->base->can_clkout = 0;
1739 		state->base->demod_num = 4;
1740 		state->base->tuner_num = 4;
1741 		state->base->sku_type = MXL_HYDRA_SKU_TYPE_544;
1742 		state->base->ts_map = ts_map54x;
1743 		break;
1744 	case MXL_HYDRA_DEVICE_541:
1745 	case MXL_HYDRA_DEVICE_541S:
1746 		state->base->can_clkout = 0;
1747 		state->base->demod_num = 4;
1748 		state->base->tuner_num = 1;
1749 		state->base->sku_type = MXL_HYDRA_SKU_TYPE_541;
1750 		state->base->ts_map = ts_map54x;
1751 		break;
1752 	case MXL_HYDRA_DEVICE_561:
1753 	case MXL_HYDRA_DEVICE_561S:
1754 		state->base->can_clkout = 0;
1755 		state->base->demod_num = 6;
1756 		state->base->tuner_num = 1;
1757 		state->base->sku_type = MXL_HYDRA_SKU_TYPE_561;
1758 		break;
1759 	case MXL_HYDRA_DEVICE_568:
1760 		state->base->can_clkout = 0;
1761 		state->base->demod_num = 8;
1762 		state->base->tuner_num = 1;
1763 		state->base->chan_bond = 1;
1764 		state->base->sku_type = MXL_HYDRA_SKU_TYPE_568;
1765 		break;
1766 	case MXL_HYDRA_DEVICE_542:
1767 		state->base->can_clkout = 1;
1768 		state->base->demod_num = 4;
1769 		state->base->tuner_num = 3;
1770 		state->base->sku_type = MXL_HYDRA_SKU_TYPE_542;
1771 		state->base->ts_map = ts_map54x;
1772 		break;
1773 	case MXL_HYDRA_DEVICE_TEST:
1774 	case MXL_HYDRA_DEVICE_584:
1775 	default:
1776 		state->base->can_clkout = 0;
1777 		state->base->demod_num = 8;
1778 		state->base->tuner_num = 4;
1779 		state->base->sku_type = MXL_HYDRA_SKU_TYPE_584;
1780 		break;
1781 	}
1782 
1783 	status = validate_sku(state);
1784 	if (status)
1785 		return status;
1786 
1787 	update_by_mnemonic(state, 0x80030014, 9, 1, 1);
1788 	update_by_mnemonic(state, 0x8003003C, 12, 1, 1);
1789 	status = read_by_mnemonic(state, 0x80030000, 12, 4, &chipver);
1790 	if (status)
1791 		state->base->chipversion = 0;
1792 	else
1793 		state->base->chipversion = (chipver == 2) ? 2 : 1;
1794 	dev_info(state->i2cdev, "Hydra chip version %u\n",
1795 		state->base->chipversion);
1796 
1797 	cfg_dev_xtal(state, cfg->clk, cfg->cap, 0);
1798 
1799 	fw = firmware_is_alive(state);
1800 	if (!fw) {
1801 		status = load_fw(state, cfg);
1802 		if (status)
1803 			return status;
1804 	}
1805 	get_fwinfo(state);
1806 
1807 	config_mux(state);
1808 	mpeg_interface_cfg.enable = MXL_ENABLE;
1809 	mpeg_interface_cfg.lsb_or_msb_first = MXL_HYDRA_MPEG_SERIAL_MSB_1ST;
1810 	/*  supports only (0-104&139)MHz */
1811 	if (cfg->ts_clk)
1812 		mpeg_interface_cfg.max_mpeg_clk_rate = cfg->ts_clk;
1813 	else
1814 		mpeg_interface_cfg.max_mpeg_clk_rate = 69; /* 139; */
1815 	mpeg_interface_cfg.mpeg_clk_phase = MXL_HYDRA_MPEG_CLK_PHASE_SHIFT_0_DEG;
1816 	mpeg_interface_cfg.mpeg_clk_pol = MXL_HYDRA_MPEG_CLK_IN_PHASE;
1817 	/* MXL_HYDRA_MPEG_CLK_GAPPED; */
1818 	mpeg_interface_cfg.mpeg_clk_type = MXL_HYDRA_MPEG_CLK_CONTINUOUS;
1819 	mpeg_interface_cfg.mpeg_error_indication =
1820 		MXL_HYDRA_MPEG_ERR_INDICATION_DISABLED;
1821 	mpeg_interface_cfg.mpeg_mode = MXL_HYDRA_MPEG_MODE_SERIAL_3_WIRE;
1822 	mpeg_interface_cfg.mpeg_sync_pol  = MXL_HYDRA_MPEG_ACTIVE_HIGH;
1823 	mpeg_interface_cfg.mpeg_sync_pulse_width  = MXL_HYDRA_MPEG_SYNC_WIDTH_BIT;
1824 	mpeg_interface_cfg.mpeg_valid_pol  = MXL_HYDRA_MPEG_ACTIVE_HIGH;
1825 
1826 	for (j = 0; j < state->base->demod_num; j++) {
1827 		status = config_ts(state, (enum MXL_HYDRA_DEMOD_ID_E) j,
1828 				   &mpeg_interface_cfg);
1829 		if (status)
1830 			return status;
1831 	}
1832 	set_drive_strength(state, 1);
1833 	return 0;
1834 }
1835 
mxl5xx_attach(struct i2c_adapter * i2c,struct mxl5xx_cfg * cfg,u32 demod,u32 tuner,int (** fn_set_input)(struct dvb_frontend *,int))1836 struct dvb_frontend *mxl5xx_attach(struct i2c_adapter *i2c,
1837 	struct mxl5xx_cfg *cfg, u32 demod, u32 tuner,
1838 	int (**fn_set_input)(struct dvb_frontend *, int))
1839 {
1840 	struct mxl *state;
1841 	struct mxl_base *base;
1842 
1843 	state = kzalloc(sizeof(struct mxl), GFP_KERNEL);
1844 	if (!state)
1845 		return NULL;
1846 
1847 	state->demod = demod;
1848 	state->tuner = tuner;
1849 	state->tuner_in_use = 0xffffffff;
1850 	state->i2cdev = &i2c->dev;
1851 
1852 	base = match_base(i2c, cfg->adr);
1853 	if (base) {
1854 		base->count++;
1855 		if (base->count > base->demod_num)
1856 			goto fail;
1857 		state->base = base;
1858 	} else {
1859 		base = kzalloc(sizeof(struct mxl_base), GFP_KERNEL);
1860 		if (!base)
1861 			goto fail;
1862 		base->i2c = i2c;
1863 		base->adr = cfg->adr;
1864 		base->type = cfg->type;
1865 		base->count = 1;
1866 		mutex_init(&base->i2c_lock);
1867 		mutex_init(&base->status_lock);
1868 		mutex_init(&base->tune_lock);
1869 		INIT_LIST_HEAD(&base->mxls);
1870 
1871 		state->base = base;
1872 		if (probe(state, cfg) < 0) {
1873 			kfree(base);
1874 			goto fail;
1875 		}
1876 		list_add(&base->mxllist, &mxllist);
1877 	}
1878 	state->fe.ops               = mxl_ops;
1879 	state->xbar[0]              = 4;
1880 	state->xbar[1]              = demod;
1881 	state->xbar[2]              = 8;
1882 	state->fe.demodulator_priv  = state;
1883 	*fn_set_input               = set_input;
1884 
1885 	list_add(&state->mxl, &base->mxls);
1886 	return &state->fe;
1887 
1888 fail:
1889 	kfree(state);
1890 	return NULL;
1891 }
1892 EXPORT_SYMBOL_GPL(mxl5xx_attach);
1893 
1894 MODULE_DESCRIPTION("MaxLinear MxL5xx DVB-S/S2 tuner-demodulator driver");
1895 MODULE_AUTHOR("Ralph and Marcus Metzler, Metzler Brothers Systementwicklung GbR");
1896 MODULE_LICENSE("GPL");
1897