ti/cal/cal-camerarx.c

25 #include "cal.h"
82 	u32 val = cal_read(phy->cal, CAL_CSI2_COMPLEXIO_CFG(phy->instance));
103 	cal_write(phy->cal, CAL_CSI2_COMPLEXIO_CFG(phy->instance), val);
110 	u32 num_lanes = phy->cal->data->camerarx[phy->instance].num_lanes;
176 	cal_write_field(phy->cal, CAL_CSI2_COMPLEXIO_CFG(phy->instance),
182 		current_state = cal_read_field(phy->cal,
203 		if (cal_read_field(phy->cal,
211 	if (cal_read_field(phy->cal, CAL_CSI2_COMPLEXIO_CFG(phy->instance),
223 		if (cal_read_field(phy->cal,
230 	if (cal_read_field(phy->cal, CAL_CSI2_TIMING(phy->instance),
253 	cal_write(phy->cal, CAL_HL_IRQENABLE_SET(0),
256 	cal_write(phy->cal, CAL_CSI2_COMPLEXIO_IRQENABLE(phy->instance),
258 	cal_write(phy->cal, CAL_CSI2_VC_IRQENABLE(phy->instance),
265 	cal_write(phy->cal, CAL_HL_IRQENABLE_CLR(0),
268 	cal_write(phy->cal, CAL_CSI2_COMPLEXIO_IRQENABLE(phy->instance), 0);
269 	cal_write(phy->cal, CAL_CSI2_VC_IRQENABLE(phy->instance), 0);
274 	cal_write_field(phy->cal, CAL_CSI2_PPI_CTRL(phy->instance),
277 	cal_write_field(phy->cal, CAL_CSI2_PPI_CTRL(phy->instance),
283 	cal_write_field(phy->cal, CAL_CSI2_PPI_CTRL(phy->instance),
338 	cal_write_field(phy->cal, CAL_CSI2_COMPLEXIO_CFG(phy->instance),
343 		cal_read(phy->cal, CAL_CSI2_COMPLEXIO_CFG(phy->instance)));
361 	sscounter = DIV_ROUND_UP(clk_get_rate(phy->cal->fclk), 10000 *  16 * 4);
363 	val = cal_read(phy->cal, CAL_CSI2_TIMING(phy->instance));
368 	cal_write(phy->cal, CAL_CSI2_TIMING(phy->instance), val);
371 		cal_read(phy->cal, CAL_CSI2_TIMING(phy->instance)));
374 	cal_write_field(phy->cal, CAL_CSI2_TIMING(phy->instance),
378 		cal_read(phy->cal, CAL_CSI2_TIMING(phy->instance)));
442 	cal_write_field(phy->cal, CAL_CSI2_COMPLEXIO_CFG(phy->instance),
448 		cal_read(phy->cal, CAL_CSI2_COMPLEXIO_CFG(phy->instance)));
490 static int cal_camerarx_regmap_init(struct cal_dev *cal,
496 	if (!cal->data)
499 	phy_data = &cal->data->camerarx[phy->instance];
503 			.reg = cal->syscon_camerrx_offset,
512 		phy->fields[i] = devm_regmap_field_alloc(cal->dev,
513 							 cal->syscon_camerrx,
516 			cal_err(cal, "Unable to allocate regmap fields\n");
536 	ep_node = of_graph_get_endpoint_by_regs(phy->cal->dev->of_node,
764 		cal_err(phy->cal,
770 		cal_err(phy->cal,
810 struct cal_camerarx *cal_camerarx_create(struct cal_dev *cal,
813 	struct platform_device *pdev = to_platform_device(cal->dev);
819 	phy = devm_kzalloc(cal->dev, sizeof(*phy), GFP_KERNEL);
823 	phy->cal = cal;
832 	phy->base = devm_ioremap_resource(cal->dev, phy->res);
834 		cal_err(cal, "failed to ioremap\n");
838 	cal_dbg(1, cal, "ioresource %s at %pa - %pa\n",
841 	ret = cal_camerarx_regmap_init(cal, phy);
856 	sd->dev = cal->dev;
871 	ret = v4l2_device_register_subdev(&cal->v4l2_dev, sd);