media/dvb-frontends/dibx000_common.c

20 static int dibx000_write_word(struct dibx000_i2c_master *mst, u16 reg, u16 val)
24 	if (mutex_lock_interruptible(&mst->i2c_buffer_lock) < 0) {
29 	mst->i2c_write_buffer[0] = (reg >> 8) & 0xff;
30 	mst->i2c_write_buffer[1] = reg & 0xff;
31 	mst->i2c_write_buffer[2] = (val >> 8) & 0xff;
32 	mst->i2c_write_buffer[3] = val & 0xff;
34 	memset(mst->msg, 0, sizeof(struct i2c_msg));
35 	mst->msg[0].addr = mst->i2c_addr;
36 	mst->msg[0].flags = 0;
37 	mst->msg[0].buf = mst->i2c_write_buffer;
38 	mst->msg[0].len = 4;
40 	ret = i2c_transfer(mst->i2c_adap, mst->msg, 1) != 1 ? -EREMOTEIO : 0;
41 	mutex_unlock(&mst->i2c_buffer_lock);
46 static u16 dibx000_read_word(struct dibx000_i2c_master *mst, u16 reg)
50 	if (mutex_lock_interruptible(&mst->i2c_buffer_lock) < 0) {
55 	mst->i2c_write_buffer[0] = reg >> 8;
56 	mst->i2c_write_buffer[1] = reg & 0xff;
58 	memset(mst->msg, 0, 2 * sizeof(struct i2c_msg));
59 	mst->msg[0].addr = mst->i2c_addr;
60 	mst->msg[0].flags = 0;
61 	mst->msg[0].buf = mst->i2c_write_buffer;
62 	mst->msg[0].len = 2;
63 	mst->msg[1].addr = mst->i2c_addr;
64 	mst->msg[1].flags = I2C_M_RD;
65 	mst->msg[1].buf = mst->i2c_read_buffer;
66 	mst->msg[1].len = 2;
68 	if (i2c_transfer(mst->i2c_adap, mst->msg, 2) != 2)
71 	ret = (mst->i2c_read_buffer[0] << 8) | mst->i2c_read_buffer[1];
72 	mutex_unlock(&mst->i2c_buffer_lock);
77 static int dibx000_is_i2c_done(struct dibx000_i2c_master *mst)
82 	while (((status = dibx000_read_word(mst, mst->base_reg + 2)) & 0x0100) == 0 && --i > 0)
96 static int dibx000_master_i2c_write(struct dibx000_i2c_master *mst, struct i2c_msg *msg, u8 stop)
105 		dibx000_read_word(mst, mst->base_reg + 2);
112 			dibx000_write_word(mst, mst->base_reg, data);
129 		dibx000_write_word(mst, mst->base_reg+1, da);
131 		if (dibx000_is_i2c_done(mst) != 0)
139 static int dibx000_master_i2c_read(struct dibx000_i2c_master *mst, struct i2c_msg *msg)
161 		dibx000_write_word(mst, mst->base_reg+1, da);
163 		if (dibx000_is_i2c_done(mst) != 0)
169 			da = dibx000_read_word(mst, mst->base_reg);
184 	struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
186 	if (mst->device_rev < DIB7000MC && speed < 235)
188 	return dibx000_write_word(mst, mst->base_reg + 3, (u16)(60000 / speed));
198 static int dibx000_i2c_select_interface(struct dibx000_i2c_master *mst,
201 	if (mst->device_rev > DIB3000MC && mst->selected_interface != intf) {
203 		mst->selected_interface = intf;
204 		return dibx000_write_word(mst, mst->base_reg + 4, intf);
211 	struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
215 	dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_GPIO_1_2);
218 			ret = dibx000_master_i2c_read(mst, &msg[msg_index]);
222 			ret = dibx000_master_i2c_write(mst, &msg[msg_index], 1);
233 	struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
237 	dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_GPIO_3_4);
240 			ret = dibx000_master_i2c_read(mst, &msg[msg_index]);
244 			ret = dibx000_master_i2c_write(mst, &msg[msg_index], 1);
263 static int dibx000_i2c_gate_ctrl(struct dibx000_i2c_master *mst, u8 tx[4],
274 	if (mst->device_rev > DIB7000)
277 	tx[0] = (((mst->base_reg + 1) >> 8) & 0xff);
278 	tx[1] = ((mst->base_reg + 1) & 0xff);
288 	struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
297 	dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_GPIO_6_7);
299 	if (mutex_lock_interruptible(&mst->i2c_buffer_lock) < 0) {
304 	memset(mst->msg, 0, sizeof(struct i2c_msg) * (2 + num));
307 	dibx000_i2c_gate_ctrl(mst, &mst->i2c_write_buffer[0], msg[0].addr, 1);
308 	mst->msg[0].addr = mst->i2c_addr;
309 	mst->msg[0].buf = &mst->i2c_write_buffer[0];
310 	mst->msg[0].len = 4;
312 	memcpy(&mst->msg[1], msg, sizeof(struct i2c_msg) * num);
315 	dibx000_i2c_gate_ctrl(mst, &mst->i2c_write_buffer[4], 0, 0);
316 	mst->msg[num + 1].addr = mst->i2c_addr;
317 	mst->msg[num + 1].buf = &mst->i2c_write_buffer[4];
318 	mst->msg[num + 1].len = 4;
320 	ret = (i2c_transfer(mst->i2c_adap, mst->msg, 2 + num) == 2 + num ?
323 	mutex_unlock(&mst->i2c_buffer_lock);
335 	struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
344 	dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_TUNER);
346 	if (mutex_lock_interruptible(&mst->i2c_buffer_lock) < 0) {
350 	memset(mst->msg, 0, sizeof(struct i2c_msg) * (2 + num));
353 	dibx000_i2c_gate_ctrl(mst, &mst->i2c_write_buffer[0], msg[0].addr, 1);
354 	mst->msg[0].addr = mst->i2c_addr;
355 	mst->msg[0].buf = &mst->i2c_write_buffer[0];
356 	mst->msg[0].len = 4;
358 	memcpy(&mst->msg[1], msg, sizeof(struct i2c_msg) * num);
361 	dibx000_i2c_gate_ctrl(mst, &mst->i2c_write_buffer[4], 0, 0);
362 	mst->msg[num + 1].addr = mst->i2c_addr;
363 	mst->msg[num + 1].buf = &mst->i2c_write_buffer[4];
364 	mst->msg[num + 1].len = 4;
366 	ret = (i2c_transfer(mst->i2c_adap, mst->msg, 2 + num) == 2 + num ?
368 	mutex_unlock(&mst->i2c_buffer_lock);
377 struct i2c_adapter *dibx000_get_i2c_adapter(struct dibx000_i2c_master *mst,
386 			i2c = &mst->gated_tuner_i2c_adap;
390 			i2c = &mst->master_i2c_adap_gpio12;
394 			i2c = &mst->master_i2c_adap_gpio34;
398 			i2c = &mst->master_i2c_adap_gpio67;
410 void dibx000_reset_i2c_master(struct dibx000_i2c_master *mst)
414 	struct i2c_msg m = {.addr = mst->i2c_addr,.buf = tx,.len = 4 };
416 	dibx000_i2c_gate_ctrl(mst, tx, 0, 0);
417 	i2c_transfer(mst->i2c_adap, &m, 1);
418 	mst->selected_interface = 0xff;	// the first time force a select of the I2C
419 	dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_TUNER);
426 				struct dibx000_i2c_master *mst)
431 	i2c_set_adapdata(i2c_adap, mst);
437 int dibx000_init_i2c_master(struct dibx000_i2c_master *mst, u16 device_rev,
442 	mutex_init(&mst->i2c_buffer_lock);
443 	if (mutex_lock_interruptible(&mst->i2c_buffer_lock) < 0) {
447 	memset(mst->msg, 0, sizeof(struct i2c_msg));
448 	mst->msg[0].addr = i2c_addr >> 1;
449 	mst->msg[0].flags = 0;
450 	mst->msg[0].buf = mst->i2c_write_buffer;
451 	mst->msg[0].len = 4;
453 	mst->device_rev = device_rev;
454 	mst->i2c_adap = i2c_adap;
455 	mst->i2c_addr = i2c_addr >> 1;
458 		mst->base_reg = 1024;
460 		mst->base_reg = 768;
462 	mst->gated_tuner_i2c_adap.dev.parent = mst->i2c_adap->dev.parent;
464 			(&mst->gated_tuner_i2c_adap, &dibx000_i2c_gated_tuner_algo,
465 			 "DiBX000 tuner I2C bus", mst) != 0)
468 	mst->master_i2c_adap_gpio12.dev.parent = mst->i2c_adap->dev.parent;
470 			(&mst->master_i2c_adap_gpio12, &dibx000_i2c_master_gpio12_xfer_algo,
471 			 "DiBX000 master GPIO12 I2C bus", mst) != 0)
474 	mst->master_i2c_adap_gpio34.dev.parent = mst->i2c_adap->dev.parent;
476 			(&mst->master_i2c_adap_gpio34, &dibx000_i2c_master_gpio34_xfer_algo,
477 			 "DiBX000 master GPIO34 I2C bus", mst) != 0)
480 	mst->master_i2c_adap_gpio67.dev.parent = mst->i2c_adap->dev.parent;
482 			(&mst->master_i2c_adap_gpio67, &dibx000_i2c_gated_gpio67_algo,
483 			 "DiBX000 master GPIO67 I2C bus", mst) != 0)
487 	dibx000_i2c_gate_ctrl(mst, mst->i2c_write_buffer, 0, 0);
489 	ret = (i2c_transfer(i2c_adap, mst->msg, 1) == 1);
490 	mutex_unlock(&mst->i2c_buffer_lock);
497 void dibx000_exit_i2c_master(struct dibx000_i2c_master *mst)
499 	i2c_del_adapter(&mst->gated_tuner_i2c_adap);
500 	i2c_del_adapter(&mst->master_i2c_adap_gpio12);
501 	i2c_del_adapter(&mst->master_i2c_adap_gpio34);
502 	i2c_del_adapter(&mst->master_i2c_adap_gpio67);