1 // SPDX-License-Identifier: GPL-2.0-only
9  * This file is named adv7511-v4l2.c so it doesn't conflict with the Analog
22 #include <linux/v4l2-dv-timings.h>
23 #include <media/v4l2-device.h>
24 #include <media/v4l2-common.h>
25 #include <media/v4l2-ctrls.h>
26 #include <media/v4l2-dv-timings.h>
32 MODULE_PARM_DESC(debug, "debug level (0-2)");
99 	/* Did we receive hotplug and rx-sense signals? */
152 	return &container_of(ctrl->handler, struct adv7511_state, hdl)->sd;  in to_sd()
155 /* ------------------------ I2C ----------------------------------------------- */
162 	if (!i2c_smbus_xfer(client->adapter, client->addr, client->flags,  in adv_smbus_read_byte_data_check()
168 			client->addr, command);  in adv_smbus_read_byte_data_check()
169 	return -1;  in adv_smbus_read_byte_data_check()
184 	return -1;  in adv_smbus_read_byte_data()
209 /* To set specific bits in the register, a clear-mask is given (to be AND-ed),
210    and then the value-mask (to be OR-ed). */
226 		ret = i2c_smbus_read_i2c_block_data(state->i2c_edid, i,  in adv7511_edid_rd()
241 	return i2c_smbus_read_byte_data(state->i2c_cec, reg);  in adv7511_cec_read()
251 		ret = i2c_smbus_write_byte_data(state->i2c_cec, reg, val);  in adv7511_cec_write()
269 	return adv_smbus_read_byte_data(state->i2c_pktmem, reg);  in adv7511_pktmem_rd()
329 				  4096-564, 0, 0, 256,  in adv7511_csc_rgb_full2limit()
330 				  0, 4096-564, 0, 256,  in adv7511_csc_rgb_full2limit()
331 				  0, 0, 4096-564, 256);  in adv7511_csc_rgb_full2limit()
334 		/* AVI infoframe: Limited range RGB (16-235) */  in adv7511_csc_rgb_full2limit()
339 		/* AVI infoframe: Full range RGB (0-255) */  in adv7511_csc_rgb_full2limit()
348 	/* Only makes sense for RGB formats */  in adv7511_set_rgb_quantization_mode()
349 	if (state->fmt_code != MEDIA_BUS_FMT_RGB888_1X24) {  in adv7511_set_rgb_quantization_mode()
355 	switch (ctrl->val) {  in adv7511_set_rgb_quantization_mode()
358 		if (state->dv_timings.bt.flags & V4L2_DV_FL_IS_CE_VIDEO) {  in adv7511_set_rgb_quantization_mode()
359 			/* CE format, RGB limited range (16-235) */  in adv7511_set_rgb_quantization_mode()
362 			/* not CE format, RGB full range (0-255) */  in adv7511_set_rgb_quantization_mode()
367 		/* RGB limited range (16-235) */  in adv7511_set_rgb_quantization_mode()
371 		/* RGB full range (0-255) */  in adv7511_set_rgb_quantization_mode()
377 /* ------------------------------ CTRL OPS ------------------------------ */
384 	v4l2_dbg(1, debug, sd, "%s: ctrl id: %d, ctrl->val %d\n", __func__, ctrl->id, ctrl->val);  in adv7511_s_ctrl()
386 	if (state->hdmi_mode_ctrl == ctrl) {  in adv7511_s_ctrl()
387 		/* Set HDMI or DVI-D */  in adv7511_s_ctrl()
388 		adv7511_wr_and_or(sd, 0xaf, 0xfd, ctrl->val == V4L2_DV_TX_MODE_HDMI ? 0x02 : 0x00);  in adv7511_s_ctrl()
391 	if (state->rgb_quantization_range_ctrl == ctrl) {  in adv7511_s_ctrl()
395 	if (state->content_type_ctrl == ctrl) {  in adv7511_s_ctrl()
398 		state->content_type = ctrl->val;  in adv7511_s_ctrl()
399 		itc = state->content_type != V4L2_DV_IT_CONTENT_TYPE_NO_ITC;  in adv7511_s_ctrl()
400 		cn = itc ? state->content_type : V4L2_DV_IT_CONTENT_TYPE_GRAPHICS;  in adv7511_s_ctrl()
406 	return -EINVAL;  in adv7511_s_ctrl()
413 /* ---------------------------- CORE OPS ------------------------------------------- */
420 	v4l2_info(sd, "0x000-0x0ff: Main Map\n");  in adv7511_inv_register()
421 	if (state->i2c_cec)  in adv7511_inv_register()
422 		v4l2_info(sd, "0x100-0x1ff: CEC Map\n");  in adv7511_inv_register()
429 	reg->size = 1;  in adv7511_g_register()
430 	switch (reg->reg >> 8) {  in adv7511_g_register()
432 		reg->val = adv7511_rd(sd, reg->reg & 0xff);  in adv7511_g_register()
435 		if (state->i2c_cec) {  in adv7511_g_register()
436 			reg->val = adv7511_cec_read(sd, reg->reg & 0xff);  in adv7511_g_register()
441 		v4l2_info(sd, "Register %03llx not supported\n", reg->reg);  in adv7511_g_register()
452 	switch (reg->reg >> 8) {  in adv7511_s_register()
454 		adv7511_wr(sd, reg->reg & 0xff, reg->val & 0xff);  in adv7511_s_register()
457 		if (state->i2c_cec) {  in adv7511_s_register()
458 			adv7511_cec_write(sd, reg->reg & 0xff, reg->val & 0xff);  in adv7511_s_register()
463 		v4l2_info(sd, "Register %03llx not supported\n", reg->reg);  in adv7511_s_register()
488 	return 256 - csum;  in hdmi_infoframe_checksum()
494 	struct device *dev = &client->dev;  in log_infoframe()
500 	if (!(adv7511_rd(sd, cri->present_reg) & cri->present_mask)) {  in log_infoframe()
501 		v4l2_info(sd, "%s infoframe not transmitted\n", cri->desc);  in log_infoframe()
505 	memcpy(buffer, cri->header, sizeof(cri->header));  in log_infoframe()
510 		v4l2_err(sd, "%s: invalid %s infoframe length %d\n", __func__, cri->desc, len);  in log_infoframe()
514 	if (cri->payload_addr >= 0x100) {  in log_infoframe()
516 			buffer[i + 4] = adv7511_pktmem_rd(sd, cri->payload_addr + i - 0x100);  in log_infoframe()
519 			buffer[i + 4] = adv7511_rd(sd, cri->payload_addr + i);  in log_infoframe()
525 		v4l2_err(sd, "%s: unpack of %s infoframe failed\n", __func__, cri->desc);  in log_infoframe()
548 	struct adv7511_state_edid *edid = &state->edid;  in adv7511_log_status()
573 	v4l2_info(sd, "power %s\n", state->power_on ? "on" : "off");  in adv7511_log_status()
574 	v4l2_info(sd, "%s hotplug, %s Rx Sense, %s EDID (%d block(s))\n",  in adv7511_log_status()
577 		  edid->segments ? "found" : "no",  in adv7511_log_status()
578 		  edid->blocks);  in adv7511_log_status()
581 		  "HDMI" : "DVI-D",  in adv7511_log_status()
586 			  errors[adv7511_rd(sd, 0xc8) >> 4], state->edid_detect_counter,  in adv7511_log_status()
613 	if (state->dv_timings.type == V4L2_DV_BT_656_1120)  in adv7511_log_status()
614 		v4l2_print_dv_timings(sd->name, "timings: ",  in adv7511_log_status()
615 				&state->dv_timings, false);  in adv7511_log_status()
618 	v4l2_info(sd, "i2c edid addr: 0x%x\n", state->i2c_edid_addr);  in adv7511_log_status()
620 	if (state->i2c_cec == NULL)  in adv7511_log_status()
623 	v4l2_info(sd, "i2c cec addr: 0x%x\n", state->i2c_cec_addr);  in adv7511_log_status()
625 	v4l2_info(sd, "CEC: %s\n", state->cec_enabled_adap ?  in adv7511_log_status()
627 	if (state->cec_enabled_adap) {  in adv7511_log_status()
629 			bool is_valid = state->cec_valid_addrs & (1 << i);  in adv7511_log_status()
633 					  state->cec_addr[i]);  in adv7511_log_status()
636 	v4l2_info(sd, "i2c pktmem addr: 0x%x\n", state->i2c_pktmem_addr);  in adv7511_log_status()
649 	state->power_on = on;  in adv7511_s_power()
685 	adv7511_wr(sd, 0x43, state->i2c_edid_addr);  in adv7511_s_power()
686 	adv7511_wr(sd, 0x45, state->i2c_pktmem_addr);  in adv7511_s_power()
697 	struct v4l2_subdev *sd = &state->sd;  in adv7511_cec_adap_enable()
699 	if (state->i2c_cec == NULL)  in adv7511_cec_adap_enable()
700 		return -EIO;  in adv7511_cec_adap_enable()
702 	if (!state->cec_enabled_adap && enable) {  in adv7511_cec_adap_enable()
714 		if (state->enabled_irq)  in adv7511_cec_adap_enable()
716 	} else if (state->cec_enabled_adap && !enable) {  in adv7511_cec_adap_enable()
717 		if (state->enabled_irq)  in adv7511_cec_adap_enable()
719 		/* disable address mask 1-3 */  in adv7511_cec_adap_enable()
723 		state->cec_valid_addrs = 0;  in adv7511_cec_adap_enable()
725 	state->cec_enabled_adap = enable;  in adv7511_cec_adap_enable()
732 	struct v4l2_subdev *sd = &state->sd;  in adv7511_cec_adap_log_addr()
735 	if (!state->cec_enabled_adap)  in adv7511_cec_adap_log_addr()
736 		return addr == CEC_LOG_ADDR_INVALID ? 0 : -EIO;  in adv7511_cec_adap_log_addr()
740 		state->cec_valid_addrs = 0;  in adv7511_cec_adap_log_addr()
745 		bool is_valid = state->cec_valid_addrs & (1 << i);  in adv7511_cec_adap_log_addr()
749 		if (is_valid && state->cec_addr[i] == addr)  in adv7511_cec_adap_log_addr()
755 			return -ENXIO;  in adv7511_cec_adap_log_addr()
757 	state->cec_addr[i] = addr;  in adv7511_cec_adap_log_addr()
758 	state->cec_valid_addrs |= 1 << i;  in adv7511_cec_adap_log_addr()
787 	struct v4l2_subdev *sd = &state->sd;  in adv7511_cec_adap_transmit()
788 	u8 len = msg->len;  in adv7511_cec_adap_transmit()
795 		return -EINVAL;  in adv7511_cec_adap_transmit()
799 	 * The number of retries is the number of attempts - 1, but retry  in adv7511_cec_adap_transmit()
803 	adv7511_cec_write_and_or(sd, 0x12, ~0x70, max(1, attempts - 1) << 4);  in adv7511_cec_adap_transmit()
810 		adv7511_cec_write(sd, i, msg->msg[i]);  in adv7511_cec_adap_transmit()
831 		cec_transmit_done(state->cec_adap, CEC_TX_STATUS_ARB_LOST,  in adv_cec_tx_raw_status()
852 		cec_transmit_done(state->cec_adap, status,  in adv_cec_tx_raw_status()
858 		cec_transmit_done(state->cec_adap, CEC_TX_STATUS_OK, 0, 0, 0, 0);  in adv_cec_tx_raw_status()
880 	if (state->enabled_irq == enable)  in adv7511_set_isr()
882 	state->enabled_irq = enable;  in adv7511_set_isr()
902 	} while (retries-- && irqs_rd != irqs);  in adv7511_set_isr()
908 			  (state->cec_enabled_adap && enable) ? 0x39 : 0x00);  in adv7511_set_isr()
925 	v4l2_dbg(1, debug, sd, "%s: irq 0x%x, cec-irq 0x%x\n", __func__,  in adv7511_isr()
955 			adv7511_cec_write(sd, 0x4a, 0); /* toggle to re-enable rx 1 */  in adv7511_isr()
957 			cec_received_msg(state->cec_adap, &msg);  in adv7511_isr()
980 /* ------------------------------ VIDEO OPS ------------------------------ */
993 		state->have_monitor = false;  in adv7511_s_stream()
1002 	struct v4l2_bt_timings *bt = &timings->bt;  in adv7511_s_dv_timings()
1009 		return -EINVAL;  in adv7511_s_dv_timings()
1016 	state->dv_timings = *timings;  in adv7511_s_dv_timings()
1020 		((bt->polarities & V4L2_DV_VSYNC_POS_POL) ? 0 : 0x40) |  in adv7511_s_dv_timings()
1021 		((bt->polarities & V4L2_DV_HSYNC_POS_POL) ? 0 : 0x20));  in adv7511_s_dv_timings()
1023 	fps = (u32)bt->pixelclock / (V4L2_DV_BT_FRAME_WIDTH(bt) * V4L2_DV_BT_FRAME_HEIGHT(bt));  in adv7511_s_dv_timings()
1040 	adv7511_set_rgb_quantization_mode(sd, state->rgb_quantization_range_ctrl);  in adv7511_s_dv_timings()
1053 		return -EINVAL;  in adv7511_g_dv_timings()
1055 	*timings = state->dv_timings;  in adv7511_g_dv_timings()
1063 	if (timings->pad != 0)  in adv7511_enum_dv_timings()
1064 		return -EINVAL;  in adv7511_enum_dv_timings()
1072 	if (cap->pad != 0)  in adv7511_dv_timings_cap()
1073 		return -EINVAL;  in adv7511_dv_timings_cap()
1085 /* ------------------------------ AUDIO OPS ------------------------------ */
1111 		return -EINVAL;  in adv7511_s_clock_freq()
1135 		return -EINVAL;  in adv7511_s_i2s_clock_freq()
1164 /* ---------------------------- PAD OPS ------------------------------------- */
1170 	memset(edid->reserved, 0, sizeof(edid->reserved));  in adv7511_get_edid()
1172 	if (edid->pad != 0)  in adv7511_get_edid()
1173 		return -EINVAL;  in adv7511_get_edid()
1175 	if (edid->start_block == 0 && edid->blocks == 0) {  in adv7511_get_edid()
1176 		edid->blocks = state->edid.blocks;  in adv7511_get_edid()
1180 	if (state->edid.blocks == 0)  in adv7511_get_edid()
1181 		return -ENODATA;  in adv7511_get_edid()
1183 	if (edid->start_block >= state->edid.blocks)  in adv7511_get_edid()
1184 		return -EINVAL;  in adv7511_get_edid()
1186 	if (edid->start_block + edid->blocks > state->edid.blocks)  in adv7511_get_edid()
1187 		edid->blocks = state->edid.blocks - edid->start_block;  in adv7511_get_edid()
1189 	memcpy(edid->edid, &state->edid.data[edid->start_block * 128],  in adv7511_get_edid()
1190 	       128 * edid->blocks);  in adv7511_get_edid()
1199 	if (code->pad != 0)  in adv7511_enum_mbus_code()
1200 		return -EINVAL;  in adv7511_enum_mbus_code()
1202 	switch (code->index) {  in adv7511_enum_mbus_code()
1204 		code->code = MEDIA_BUS_FMT_RGB888_1X24;  in adv7511_enum_mbus_code()
1207 		code->code = MEDIA_BUS_FMT_YUYV8_1X16;  in adv7511_enum_mbus_code()
1210 		code->code = MEDIA_BUS_FMT_UYVY8_1X16;  in adv7511_enum_mbus_code()
1213 		return -EINVAL;  in adv7511_enum_mbus_code()
1221 	format->width = state->dv_timings.bt.width;  in adv7511_fill_format()
1222 	format->height = state->dv_timings.bt.height;  in adv7511_fill_format()
1223 	format->field = V4L2_FIELD_NONE;  in adv7511_fill_format()
1232 	if (format->pad != 0)  in adv7511_get_fmt()
1233 		return -EINVAL;  in adv7511_get_fmt()
1235 	memset(&format->format, 0, sizeof(format->format));  in adv7511_get_fmt()
1236 	adv7511_fill_format(state, &format->format);  in adv7511_get_fmt()
1238 	if (format->which == V4L2_SUBDEV_FORMAT_TRY) {  in adv7511_get_fmt()
1241 		fmt = v4l2_subdev_get_try_format(sd, sd_state, format->pad);  in adv7511_get_fmt()
1242 		format->format.code = fmt->code;  in adv7511_get_fmt()
1243 		format->format.colorspace = fmt->colorspace;  in adv7511_get_fmt()
1244 		format->format.ycbcr_enc = fmt->ycbcr_enc;  in adv7511_get_fmt()
1245 		format->format.quantization = fmt->quantization;  in adv7511_get_fmt()
1246 		format->format.xfer_func = fmt->xfer_func;  in adv7511_get_fmt()
1248 		format->format.code = state->fmt_code;  in adv7511_get_fmt()
1249 		format->format.colorspace = state->colorspace;  in adv7511_get_fmt()
1250 		format->format.ycbcr_enc = state->ycbcr_enc;  in adv7511_get_fmt()
1251 		format->format.quantization = state->quantization;  in adv7511_get_fmt()
1252 		format->format.xfer_func = state->xfer_func;  in adv7511_get_fmt()
1264 	 * Bitfield namings come the CEA-861-F standard, table 8 "Auxiliary  in adv7511_set_fmt()
1278 	u8 itc = state->content_type != V4L2_DV_IT_CONTENT_TYPE_NO_ITC;  in adv7511_set_fmt()
1279 	u8 cn = itc ? state->content_type : V4L2_DV_IT_CONTENT_TYPE_GRAPHICS;  in adv7511_set_fmt()
1281 	if (format->pad != 0)  in adv7511_set_fmt()
1282 		return -EINVAL;  in adv7511_set_fmt()
1283 	switch (format->format.code) {  in adv7511_set_fmt()
1289 		return -EINVAL;  in adv7511_set_fmt()
1292 	adv7511_fill_format(state, &format->format);  in adv7511_set_fmt()
1293 	if (format->which == V4L2_SUBDEV_FORMAT_TRY) {  in adv7511_set_fmt()
1296 		fmt = v4l2_subdev_get_try_format(sd, sd_state, format->pad);  in adv7511_set_fmt()
1297 		fmt->code = format->format.code;  in adv7511_set_fmt()
1298 		fmt->colorspace = format->format.colorspace;  in adv7511_set_fmt()
1299 		fmt->ycbcr_enc = format->format.ycbcr_enc;  in adv7511_set_fmt()
1300 		fmt->quantization = format->format.quantization;  in adv7511_set_fmt()
1301 		fmt->xfer_func = format->format.xfer_func;  in adv7511_set_fmt()
1305 	switch (format->format.code) {  in adv7511_set_fmt()
1322 	state->fmt_code = format->format.code;  in adv7511_set_fmt()
1323 	state->colorspace = format->format.colorspace;  in adv7511_set_fmt()
1324 	state->ycbcr_enc = format->format.ycbcr_enc;  in adv7511_set_fmt()
1325 	state->quantization = format->format.quantization;  in adv7511_set_fmt()
1326 	state->xfer_func = format->format.xfer_func;  in adv7511_set_fmt()
1328 	switch (format->format.colorspace) {  in adv7511_set_fmt()
1336 		if (y && format->format.ycbcr_enc == V4L2_YCBCR_ENC_XV601) {  in adv7511_set_fmt()
1343 		if (y && format->format.ycbcr_enc == V4L2_YCBCR_ENC_XV709) {  in adv7511_set_fmt()
1355 		if (y && format->format.ycbcr_enc == V4L2_YCBCR_ENC_BT2020_CONST_LUM)  in adv7511_set_fmt()
1365 	 * CEA-861-F says that for RGB formats the YCC range must match the  in adv7511_set_fmt()
1368 	 * The RGB quantization range shouldn't be non-zero if the EDID doesn't  in adv7511_set_fmt()
1373 	 * The same is true for the YCC quantization range: non-standard YCC  in adv7511_set_fmt()
1377 	switch (format->format.quantization) {  in adv7511_set_fmt()
1381 		yq = q ? q - 1 : HDMI_YCC_QUANTIZATION_RANGE_FULL;  in adv7511_set_fmt()
1386 		yq = q ? q - 1 : HDMI_YCC_QUANTIZATION_RANGE_LIMITED;  in adv7511_set_fmt()
1396 	adv7511_set_rgb_quantization_mode(sd, state->rgb_quantization_range_ctrl);  in adv7511_set_fmt()
1410 /* --------------------- SUBDEV OPS --------------------------------------- */
1419 /* ----------------------------------------------------------------------- */
1449 	cec_s_phys_addr(state->cec_adap, ed.phys_addr, false);  in adv7511_notify_no_edid()
1451 	v4l2_ctrl_s_ctrl(state->have_edid0_ctrl, 0x0);  in adv7511_notify_no_edid()
1458 	struct v4l2_subdev *sd = &state->sd;  in adv7511_edid_handler()
1471 		if (state->edid.read_retries) {  in adv7511_edid_handler()
1472 			state->edid.read_retries--;  in adv7511_edid_handler()
1474 			state->have_monitor = false;  in adv7511_edid_handler()
1477 			queue_delayed_work(state->work_queue, &state->edid_handler, EDID_DELAY);  in adv7511_edid_handler()
1506 	/* 1st order interpolation 4:2:2 -> 4:4:4 up conversion, Aspect ratio: 16:9 */  in adv7511_setup()
1527 	v4l2_ctrl_handler_setup(&state->hdl);  in adv7511_setup()
1535 	mdt.present = state->have_monitor;  in adv7511_notify_monitor_detect()
1542 	/* read hotplug and rx-sense state */  in adv7511_check_monitor_present_status()
1549 			 status & MASK_ADV7511_MSEN_DETECT ? ", rx-sense" : "");  in adv7511_check_monitor_present_status()
1552 	v4l2_ctrl_s_ctrl(state->hotplug_ctrl, adv7511_have_hotplug(sd) ? 0x1 : 0x0);  in adv7511_check_monitor_present_status()
1553 	v4l2_ctrl_s_ctrl(state->rx_sense_ctrl, adv7511_have_rx_sense(sd) ? 0x1 : 0x0);  in adv7511_check_monitor_present_status()
1555 …if ((status & MASK_ADV7511_HPD_DETECT) && ((status & MASK_ADV7511_MSEN_DETECT) || state->edid.segm…  in adv7511_check_monitor_present_status()
1556 		v4l2_dbg(1, debug, sd, "%s: hotplug and (rx-sense or edid)\n", __func__);  in adv7511_check_monitor_present_status()
1557 		if (!state->have_monitor) {  in adv7511_check_monitor_present_status()
1559 			state->have_monitor = true;  in adv7511_check_monitor_present_status()
1567 			state->edid.read_retries = EDID_MAX_RETRIES;  in adv7511_check_monitor_present_status()
1568 			queue_delayed_work(state->work_queue, &state->edid_handler, EDID_DELAY);  in adv7511_check_monitor_present_status()
1572 		state->edid.read_retries = EDID_MAX_RETRIES;  in adv7511_check_monitor_present_status()
1573 		queue_delayed_work(state->work_queue, &state->edid_handler, EDID_DELAY);  in adv7511_check_monitor_present_status()
1576 		if (state->have_monitor) {  in adv7511_check_monitor_present_status()
1578 			state->have_monitor = false;  in adv7511_check_monitor_present_status()
1582 		memset(&state->edid, 0, sizeof(struct adv7511_state_edid));  in adv7511_check_monitor_present_status()
1600 	u32 blocks = state->edid.blocks;  in edid_verify_crc()
1601 	u8 *data = state->edid.data;  in edid_verify_crc()
1616 	u8 *data = state->edid.data;  in edid_verify_header()
1629 			 __func__, EDID_MAX_RETRIES - state->edid.read_retries);  in adv7511_check_edid_status()
1631 	if (state->edid.complete)  in adv7511_check_edid_status()
1644 		err = adv7511_edid_rd(sd, 256, &state->edid.data[segment * 256]);  in adv7511_check_edid_status()
1646 			adv7511_dbg_dump_edid(2, debug, sd, segment, &state->edid.data[segment * 256]);  in adv7511_check_edid_status()
1648 				state->edid.blocks = state->edid.data[0x7e] + 1;  in adv7511_check_edid_status()
1650 					 __func__, state->edid.blocks);  in adv7511_check_edid_status()
1658 			state->have_monitor = false;  in adv7511_check_edid_status()
1664 		state->edid.segments = segment + 1;  in adv7511_check_edid_status()
1665 		v4l2_ctrl_s_ctrl(state->have_edid0_ctrl, 0x1);  in adv7511_check_edid_status()
1666 		if (((state->edid.data[0x7e] >> 1) + 1) > state->edid.segments) {  in adv7511_check_edid_status()
1668 			v4l2_dbg(1, debug, sd, "%s: request segment %d\n", __func__, state->edid.segments);  in adv7511_check_edid_status()
1670 			adv7511_wr(sd, 0xc4, state->edid.segments);  in adv7511_check_edid_status()
1671 			state->edid.read_retries = EDID_MAX_RETRIES;  in adv7511_check_edid_status()
1672 			queue_delayed_work(state->work_queue, &state->edid_handler, EDID_DELAY);  in adv7511_check_edid_status()
1676 		v4l2_dbg(1, debug, sd, "%s: edid complete with %d segment(s)\n", __func__, state->edid.segments);  in adv7511_check_edid_status()
1677 		state->edid.complete = true;  in adv7511_check_edid_status()
1678 		ed.phys_addr = cec_get_edid_phys_addr(state->edid.data,  in adv7511_check_edid_status()
1679 						      state->edid.segments * 256,  in adv7511_check_edid_status()
1686 		state->edid_detect_counter++;  in adv7511_check_edid_status()
1687 		cec_s_phys_addr(state->cec_adap, ed.phys_addr, false);  in adv7511_check_edid_status()
1701 	err = cec_register_adapter(state->cec_adap, &client->dev);  in adv7511_registered()
1703 		cec_delete_adapter(state->cec_adap);  in adv7511_registered()
1711 	cec_unregister_adapter(state->cec_adap);  in adv7511_unregistered()
1719 /* ----------------------------------------------------------------------- */
1724 	struct adv7511_state_edid *edid = &state->edid;  in adv7511_init_setup()
1725 	u32 cec_clk = state->pdata.cec_clk;  in adv7511_init_setup()
1735 	 * It might leave the chip in a partly un-initialized state,  in adv7511_init_setup()
1740 	state->have_monitor = false;  in adv7511_init_setup()
1745 	if (state->i2c_cec == NULL)  in adv7511_init_setup()
1762 	ratio = (cec_clk / 750000) - 1;  in adv7511_init_setup()
1769 	struct adv7511_platform_data *pdata = client->dev.platform_data;  in adv7511_probe()
1773 	int err = -EIO;  in adv7511_probe()
1776 	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))  in adv7511_probe()
1777 		return -EIO;  in adv7511_probe()
1779 	state = devm_kzalloc(&client->dev, sizeof(struct adv7511_state), GFP_KERNEL);  in adv7511_probe()
1781 		return -ENOMEM;  in adv7511_probe()
1786 		return -ENODEV;  in adv7511_probe()
1788 	memcpy(&state->pdata, pdata, sizeof(state->pdata));  in adv7511_probe()
1789 	state->fmt_code = MEDIA_BUS_FMT_RGB888_1X24;  in adv7511_probe()
1790 	state->colorspace = V4L2_COLORSPACE_SRGB;  in adv7511_probe()
1792 	sd = &state->sd;  in adv7511_probe()
1795 			 client->addr << 1);  in adv7511_probe()
1798 	sd->internal_ops = &adv7511_int_ops;  in adv7511_probe()
1800 	hdl = &state->hdl;  in adv7511_probe()
1803 	state->hdmi_mode_ctrl = v4l2_ctrl_new_std_menu(hdl, &adv7511_ctrl_ops,  in adv7511_probe()
1806 	state->hotplug_ctrl = v4l2_ctrl_new_std(hdl, NULL,  in adv7511_probe()
1808 	state->rx_sense_ctrl = v4l2_ctrl_new_std(hdl, NULL,  in adv7511_probe()
1810 	state->have_edid0_ctrl = v4l2_ctrl_new_std(hdl, NULL,  in adv7511_probe()
1812 	state->rgb_quantization_range_ctrl =  in adv7511_probe()
1816 	state->content_type_ctrl =  in adv7511_probe()
1820 	sd->ctrl_handler = hdl;  in adv7511_probe()
1821 	if (hdl->error) {  in adv7511_probe()
1822 		err = hdl->error;  in adv7511_probe()
1825 	state->pad.flags = MEDIA_PAD_FL_SINK;  in adv7511_probe()
1826 	sd->entity.function = MEDIA_ENT_F_DV_ENCODER;  in adv7511_probe()
1827 	err = media_entity_pads_init(&sd->entity, 1, &state->pad);  in adv7511_probe()
1832 	state->i2c_edid_addr = state->pdata.i2c_edid << 1;  in adv7511_probe()
1833 	state->i2c_cec_addr = state->pdata.i2c_cec << 1;  in adv7511_probe()
1834 	state->i2c_pktmem_addr = state->pdata.i2c_pktmem << 1;  in adv7511_probe()
1836 	state->chip_revision = adv7511_rd(sd, 0x0);  in adv7511_probe()
1842 		err = -EIO;  in adv7511_probe()
1846 	state->i2c_edid = i2c_new_dummy_device(client->adapter,  in adv7511_probe()
1847 					state->i2c_edid_addr >> 1);  in adv7511_probe()
1848 	if (IS_ERR(state->i2c_edid)) {  in adv7511_probe()
1850 		err = PTR_ERR(state->i2c_edid);  in adv7511_probe()
1854 	adv7511_wr(sd, 0xe1, state->i2c_cec_addr);  in adv7511_probe()
1855 	if (state->pdata.cec_clk < 3000000 ||  in adv7511_probe()
1856 	    state->pdata.cec_clk > 100000000) {  in adv7511_probe()
1858 				__func__, state->pdata.cec_clk);  in adv7511_probe()
1859 		state->pdata.cec_clk = 0;  in adv7511_probe()
1862 	if (state->pdata.cec_clk) {  in adv7511_probe()
1863 		state->i2c_cec = i2c_new_dummy_device(client->adapter,  in adv7511_probe()
1864 					       state->i2c_cec_addr >> 1);  in adv7511_probe()
1865 		if (IS_ERR(state->i2c_cec)) {  in adv7511_probe()
1867 			err = PTR_ERR(state->i2c_cec);  in adv7511_probe()
1875 	state->i2c_pktmem = i2c_new_dummy_device(client->adapter, state->i2c_pktmem_addr >> 1);  in adv7511_probe()
1876 	if (IS_ERR(state->i2c_pktmem)) {  in adv7511_probe()
1878 		err = PTR_ERR(state->i2c_pktmem);  in adv7511_probe()
1882 	state->work_queue = create_singlethread_workqueue(sd->name);  in adv7511_probe()
1883 	if (state->work_queue == NULL) {  in adv7511_probe()
1885 		err = -ENOMEM;  in adv7511_probe()
1889 	INIT_DELAYED_WORK(&state->edid_handler, adv7511_edid_handler);  in adv7511_probe()
1894 	state->cec_adap = cec_allocate_adapter(&adv7511_cec_adap_ops,  in adv7511_probe()
1895 		state, dev_name(&client->dev), CEC_CAP_DEFAULTS,  in adv7511_probe()
1897 	err = PTR_ERR_OR_ZERO(state->cec_adap);  in adv7511_probe()
1899 		destroy_workqueue(state->work_queue);  in adv7511_probe()
1907 	v4l2_info(sd, "%s found @ 0x%x (%s)\n", client->name,  in adv7511_probe()
1908 			  client->addr << 1, client->adapter->name);  in adv7511_probe()
1912 	i2c_unregister_device(state->i2c_pktmem);  in adv7511_probe()
1914 	i2c_unregister_device(state->i2c_cec);  in adv7511_probe()
1916 	i2c_unregister_device(state->i2c_edid);  in adv7511_probe()
1918 	media_entity_cleanup(&sd->entity);  in adv7511_probe()
1920 	v4l2_ctrl_handler_free(&state->hdl);  in adv7511_probe()
1924 /* ----------------------------------------------------------------------- */
1931 	state->chip_revision = -1;  in adv7511_remove()
1933 	v4l2_dbg(1, debug, sd, "%s removed @ 0x%x (%s)\n", client->name,  in adv7511_remove()
1934 		 client->addr << 1, client->adapter->name);  in adv7511_remove()
1938 	cancel_delayed_work_sync(&state->edid_handler);  in adv7511_remove()
1939 	i2c_unregister_device(state->i2c_edid);  in adv7511_remove()
1940 	i2c_unregister_device(state->i2c_cec);  in adv7511_remove()
1941 	i2c_unregister_device(state->i2c_pktmem);  in adv7511_remove()
1942 	destroy_workqueue(state->work_queue);  in adv7511_remove()
1944 	media_entity_cleanup(&sd->entity);  in adv7511_remove()
1945 	v4l2_ctrl_handler_free(sd->ctrl_handler);  in adv7511_remove()
1948 /* ----------------------------------------------------------------------- */
1951 	{ "adv7511-v4l2", 0 },
1958 		.name = "adv7511-v4l2",