53 static int read_block(struct cxd *ci, u8 adr, u8 *data, u16 n)  in read_block()  argument
57 	if (ci->lastaddress != adr)  in read_block()
58 		status = regmap_write(ci->regmap, 0, adr);  in read_block()
60 		ci->lastaddress = adr;  in read_block()
65 			if (ci->cfg.max_i2c && len > ci->cfg.max_i2c)  in read_block()
66 				len = ci->cfg.max_i2c;  in read_block()
67 			status = regmap_raw_read(ci->regmap, 1, data, len);  in read_block()
77 static int read_reg(struct cxd *ci, u8 reg, u8 *val)  in read_reg()  argument
79 	return read_block(ci, reg, val, 1);  in read_reg()
82 static int read_pccard(struct cxd *ci, u16 address, u8 *data, u8 n)  in read_pccard()  argument
87 	status = regmap_raw_write(ci->regmap, 2, addr, 2);  in read_pccard()
89 		status = regmap_raw_read(ci->regmap, 3, data, n);  in read_pccard()
93 static int write_pccard(struct cxd *ci, u16 address, u8 *data, u8 n)  in write_pccard()  argument
98 	status = regmap_raw_write(ci->regmap, 2, addr, 2);  in write_pccard()
103 		status = regmap_raw_write(ci->regmap, 3, buf, n);  in write_pccard()
108 static int read_io(struct cxd *ci, u16 address, unsigned int *val)  in read_io()  argument
113 	status = regmap_raw_write(ci->regmap, 2, addr, 2);  in read_io()
115 		status = regmap_read(ci->regmap, 3, val);  in read_io()
119 static int write_io(struct cxd *ci, u16 address, u8 val)  in write_io()  argument
124 	status = regmap_raw_write(ci->regmap, 2, addr, 2);  in write_io()
126 		status = regmap_write(ci->regmap, 3, val);  in write_io()
130 static int write_regm(struct cxd *ci, u8 reg, u8 val, u8 mask)  in write_regm()  argument
135 	if (ci->lastaddress != reg)  in write_regm()
136 		status = regmap_write(ci->regmap, 0, reg);  in write_regm()
138 		status = regmap_read(ci->regmap, 1, &regval);  in write_regm()
139 		ci->regs[reg] = regval;  in write_regm()
141 	ci->lastaddress = reg;  in write_regm()
142 	ci->regs[reg] = (ci->regs[reg] & (~mask)) | val;  in write_regm()
144 		status = regmap_write(ci->regmap, 1, ci->regs[reg]);  in write_regm()
146 		ci->regs[reg] &= 0x7f;  in write_regm()
150 static int write_reg(struct cxd *ci, u8 reg, u8 val)  in write_reg()  argument
152 	return write_regm(ci, reg, val, 0xff);  in write_reg()
155 static int write_block(struct cxd *ci, u8 adr, u8 *data, u16 n)  in write_block()  argument
158 	u8 *buf = ci->wbuf;  in write_block()
160 	if (ci->lastaddress != adr)  in write_block()
161 		status = regmap_write(ci->regmap, 0, adr);  in write_block()
165 	ci->lastaddress = adr;  in write_block()
169 		if (ci->cfg.max_i2c && (len + 1 > ci->cfg.max_i2c))  in write_block()
170 			len = ci->cfg.max_i2c - 1;  in write_block()
172 		status = regmap_raw_write(ci->regmap, 1, buf, len);  in write_block()
181 static void set_mode(struct cxd *ci, int mode)  in set_mode()  argument
183 	if (mode == ci->mode)  in set_mode()
188 		write_regm(ci, 0x06, 0x00, 0x07);  in set_mode()
191 		write_regm(ci, 0x06, 0x02, 0x07);  in set_mode()
196 	ci->mode = mode;  in set_mode()
199 static void cam_mode(struct cxd *ci, int mode)  in cam_mode()  argument
203 	if (mode == ci->cammode)  in cam_mode()
208 		write_regm(ci, 0x20, 0x80, 0x80);  in cam_mode()
211 		if (!ci->en.read_data)  in cam_mode()
213 		ci->write_busy = 0;  in cam_mode()
214 		dev_info(&ci->client->dev, "enable cam buffer mode\n");  in cam_mode()
215 		write_reg(ci, 0x0d, 0x00);  in cam_mode()
216 		write_reg(ci, 0x0e, 0x01);  in cam_mode()
217 		write_regm(ci, 0x08, 0x40, 0x40);  in cam_mode()
218 		read_reg(ci, 0x12, &dummy);  in cam_mode()
219 		write_regm(ci, 0x08, 0x80, 0x80);  in cam_mode()
224 	ci->cammode = mode;  in cam_mode()
227 static int init(struct cxd *ci)  in init()  argument
231 	mutex_lock(&ci->lock);  in init()
232 	ci->mode = -1;  in init()
234 		status = write_reg(ci, 0x00, 0x00);  in init()
237 		status = write_reg(ci, 0x01, 0x00);  in init()
240 		status = write_reg(ci, 0x02, 0x10);  in init()
243 		status = write_reg(ci, 0x03, 0x00);  in init()
246 		status = write_reg(ci, 0x05, 0xFF);  in init()
249 		status = write_reg(ci, 0x06, 0x1F);  in init()
252 		status = write_reg(ci, 0x07, 0x1F);  in init()
255 		status = write_reg(ci, 0x08, 0x28);  in init()
258 		status = write_reg(ci, 0x14, 0x20);  in init()
265 		status = write_reg(ci, 0x0A, 0xA7);  in init()
269 		status = write_reg(ci, 0x0B, 0x33);  in init()
272 		status = write_reg(ci, 0x0C, 0x33);  in init()
276 		status = write_regm(ci, 0x14, 0x00, 0x0F);  in init()
279 		status = write_reg(ci, 0x15, ci->clk_reg_b);  in init()
282 		status = write_regm(ci, 0x16, 0x00, 0x0F);  in init()
285 		status = write_reg(ci, 0x17, ci->clk_reg_f);  in init()
289 		if (ci->cfg.clock_mode == 2) {  in init()
291 			u32 reg = ((ci->cfg.bitrate << 13) + 71999) / 72000;  in init()
293 			if (ci->cfg.polarity) {  in init()
294 				status = write_reg(ci, 0x09, 0x6f);  in init()
298 				status = write_reg(ci, 0x09, 0x6d);  in init()
302 			status = write_reg(ci, 0x20, 0x08);  in init()
305 			status = write_reg(ci, 0x21, (reg >> 8) & 0xff);  in init()
308 			status = write_reg(ci, 0x22, reg & 0xff);  in init()
311 		} else if (ci->cfg.clock_mode == 1) {  in init()
312 			if (ci->cfg.polarity) {  in init()
313 				status = write_reg(ci, 0x09, 0x6f); /* D */  in init()
317 				status = write_reg(ci, 0x09, 0x6d);  in init()
321 			status = write_reg(ci, 0x20, 0x68);  in init()
324 			status = write_reg(ci, 0x21, 0x00);  in init()
327 			status = write_reg(ci, 0x22, 0x02);  in init()
331 			if (ci->cfg.polarity) {  in init()
332 				status = write_reg(ci, 0x09, 0x4f); /* C */  in init()
336 				status = write_reg(ci, 0x09, 0x4d);  in init()
340 			status = write_reg(ci, 0x20, 0x28);  in init()
343 			status = write_reg(ci, 0x21, 0x00);  in init()
346 			status = write_reg(ci, 0x22, 0x07);  in init()
351 		status = write_regm(ci, 0x20, 0x80, 0x80);  in init()
354 		status = write_regm(ci, 0x03, 0x02, 0x02);  in init()
357 		status = write_reg(ci, 0x01, 0x04);  in init()
360 		status = write_reg(ci, 0x00, 0x31);  in init()
365 		status = write_regm(ci, 0x09, 0x08, 0x08);  in init()
368 		ci->cammode = -1;  in init()
369 		cam_mode(ci, 0);  in init()
371 	mutex_unlock(&ci->lock);  in init()
379 	struct cxd *ci = ca->data;  in read_attribute_mem()  local
382 	mutex_lock(&ci->lock);  in read_attribute_mem()
383 	set_mode(ci, 1);  in read_attribute_mem()
384 	read_pccard(ci, address, &val, 1);  in read_attribute_mem()
385 	mutex_unlock(&ci->lock);  in read_attribute_mem()
392 	struct cxd *ci = ca->data;  in write_attribute_mem()  local
394 	mutex_lock(&ci->lock);  in write_attribute_mem()
395 	set_mode(ci, 1);  in write_attribute_mem()
396 	write_pccard(ci, address, &value, 1);  in write_attribute_mem()
397 	mutex_unlock(&ci->lock);  in write_attribute_mem()
404 	struct cxd *ci = ca->data;  in read_cam_control()  local
407 	mutex_lock(&ci->lock);  in read_cam_control()
408 	set_mode(ci, 0);  in read_cam_control()
409 	read_io(ci, address, &val);  in read_cam_control()
410 	mutex_unlock(&ci->lock);  in read_cam_control()
417 	struct cxd *ci = ca->data;  in write_cam_control()  local
419 	mutex_lock(&ci->lock);  in write_cam_control()
420 	set_mode(ci, 0);  in write_cam_control()
421 	write_io(ci, address, value);  in write_cam_control()
422 	mutex_unlock(&ci->lock);  in write_cam_control()
428 	struct cxd *ci = ca->data;  in slot_reset()  local
430 	if (ci->cammode)  in slot_reset()
431 		read_data(ca, slot, ci->rbuf, 0);  in slot_reset()
433 	mutex_lock(&ci->lock);  in slot_reset()
434 	cam_mode(ci, 0);  in slot_reset()
435 	write_reg(ci, 0x00, 0x21);  in slot_reset()
436 	write_reg(ci, 0x06, 0x1F);  in slot_reset()
437 	write_reg(ci, 0x00, 0x31);  in slot_reset()
438 	write_regm(ci, 0x20, 0x80, 0x80);  in slot_reset()
439 	write_reg(ci, 0x03, 0x02);  in slot_reset()
440 	ci->ready = 0;  in slot_reset()
441 	ci->mode = -1;  in slot_reset()
447 			if (ci->ready)  in slot_reset()
451 	mutex_unlock(&ci->lock);  in slot_reset()
457 	struct cxd *ci = ca->data;  in slot_shutdown()  local
459 	dev_dbg(&ci->client->dev, "%s\n", __func__);  in slot_shutdown()
460 	if (ci->cammode)  in slot_shutdown()
461 		read_data(ca, slot, ci->rbuf, 0);  in slot_shutdown()
462 	mutex_lock(&ci->lock);  in slot_shutdown()
463 	write_reg(ci, 0x00, 0x21);  in slot_shutdown()
464 	write_reg(ci, 0x06, 0x1F);  in slot_shutdown()
467 	write_regm(ci, 0x09, 0x08, 0x08);  in slot_shutdown()
468 	write_regm(ci, 0x20, 0x80, 0x80); /* Reset CAM Mode */  in slot_shutdown()
469 	write_regm(ci, 0x06, 0x07, 0x07); /* Clear IO Mode */  in slot_shutdown()
471 	ci->mode = -1;  in slot_shutdown()
472 	ci->write_busy = 0;  in slot_shutdown()
473 	mutex_unlock(&ci->lock);  in slot_shutdown()
479 	struct cxd *ci = ca->data;  in slot_ts_enable()  local
481 	mutex_lock(&ci->lock);  in slot_ts_enable()
482 	write_regm(ci, 0x09, 0x00, 0x08);  in slot_ts_enable()
483 	set_mode(ci, 0);  in slot_ts_enable()
484 	cam_mode(ci, 1);  in slot_ts_enable()
485 	mutex_unlock(&ci->lock);  in slot_ts_enable()
489 static int campoll(struct cxd *ci)  in campoll()  argument
493 	read_reg(ci, 0x04, &istat);  in campoll()
496 	write_reg(ci, 0x05, istat);  in campoll()
499 		ci->dr = 1;  in campoll()
501 		ci->write_busy = 0;  in campoll()
506 		read_reg(ci, 0x01, &slotstat);  in campoll()
508 			if (!ci->slot_stat) {  in campoll()
509 				ci->slot_stat |=  in campoll()
511 				write_regm(ci, 0x03, 0x08, 0x08);  in campoll()
515 			if (ci->slot_stat) {  in campoll()
516 				ci->slot_stat = 0;  in campoll()
517 				write_regm(ci, 0x03, 0x00, 0x08);  in campoll()
518 				dev_info(&ci->client->dev, "NO CAM\n");  in campoll()
519 				ci->ready = 0;  in campoll()
523 		    ci->slot_stat == DVB_CA_EN50221_POLL_CAM_PRESENT) {  in campoll()
524 			ci->ready = 1;  in campoll()
525 			ci->slot_stat |= DVB_CA_EN50221_POLL_CAM_READY;  in campoll()
533 	struct cxd *ci = ca->data;  in poll_slot_status()  local
536 	mutex_lock(&ci->lock);  in poll_slot_status()
537 	campoll(ci);  in poll_slot_status()
538 	read_reg(ci, 0x01, &slotstat);  in poll_slot_status()
539 	mutex_unlock(&ci->lock);  in poll_slot_status()
541 	return ci->slot_stat;  in poll_slot_status()
546 	struct cxd *ci = ca->data;  in read_data()  local
550 	mutex_lock(&ci->lock);  in read_data()
551 	campoll(ci);  in read_data()
552 	mutex_unlock(&ci->lock);  in read_data()
554 	if (!ci->dr)  in read_data()
557 	mutex_lock(&ci->lock);  in read_data()
558 	read_reg(ci, 0x0f, &msb);  in read_data()
559 	read_reg(ci, 0x10, &lsb);  in read_data()
563 		read_block(ci, 0x12, ci->rbuf, len);  in read_data()
564 		mutex_unlock(&ci->lock);  in read_data()
567 	read_block(ci, 0x12, ebuf, len);  in read_data()
568 	ci->dr = 0;  in read_data()
569 	mutex_unlock(&ci->lock);  in read_data()
575 	struct cxd *ci = ca->data;  in write_data()  local
577 	if (ci->write_busy)  in write_data()
579 	mutex_lock(&ci->lock);  in write_data()
580 	write_reg(ci, 0x0d, ecount >> 8);  in write_data()
581 	write_reg(ci, 0x0e, ecount & 0xff);  in write_data()
582 	write_block(ci, 0x11, ebuf, ecount);  in write_data()
583 	ci->write_busy = 1;  in write_data()
584 	mutex_unlock(&ci->lock);  in write_data()
603 	struct cxd *ci;  in cxd2099_probe()  local
612 	ci = kzalloc(sizeof(*ci), GFP_KERNEL);  in cxd2099_probe()
613 	if (!ci) {  in cxd2099_probe()
618 	ci->client = client;  in cxd2099_probe()
619 	memcpy(&ci->cfg, cfg, sizeof(ci->cfg));  in cxd2099_probe()
621 	ci->regmap = regmap_init_i2c(client, &rm_cfg);  in cxd2099_probe()
622 	if (IS_ERR(ci->regmap)) {  in cxd2099_probe()
623 		ret = PTR_ERR(ci->regmap);  in cxd2099_probe()
627 	ret = regmap_read(ci->regmap, 0x00, &val);  in cxd2099_probe()
634 	mutex_init(&ci->lock);  in cxd2099_probe()
635 	ci->lastaddress = 0xff;  in cxd2099_probe()
636 	ci->clk_reg_b = 0x4a;  in cxd2099_probe()
637 	ci->clk_reg_f = 0x1b;  in cxd2099_probe()
639 	ci->en = en_templ;  in cxd2099_probe()
640 	ci->en.data = ci;  in cxd2099_probe()
641 	init(ci);  in cxd2099_probe()
644 	*cfg->en = &ci->en;  in cxd2099_probe()
647 		ci->en.read_data = NULL;  in cxd2099_probe()
648 		ci->en.write_data = NULL;  in cxd2099_probe()
653 	i2c_set_clientdata(client, ci);  in cxd2099_probe()
658 	regmap_exit(ci->regmap);  in cxd2099_probe()
660 	kfree(ci);  in cxd2099_probe()
668 	struct cxd *ci = i2c_get_clientdata(client);  in cxd2099_remove()  local
670 	regmap_exit(ci->regmap);  in cxd2099_remove()
671 	kfree(ci);  in cxd2099_remove()