forked from Minki/linux
media: omap3isp: Parse CSI1 configuration from the device tree
Add support for parsing CSI1 configuration. Signed-off-by: Pavel Machek <pavel@ucw.cz> Signed-off-by: Sakari Ailus <sakari.ailus@linux.intel.com> Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Reviewed-by: Sebastian Reichel <sebastian.reichel@collabora.co.uk> Tested-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> # on Beagleboard-xM + MPT9P031 Signed-off-by: Mauro Carvalho Chehab <mchehab@s-opensource.com>
This commit is contained in:
parent
cb74749493
commit
9211434bad
@ -2018,6 +2018,7 @@ static int isp_fwnode_parse(struct device *dev, struct fwnode_handle *fwnode,
|
||||
struct v4l2_fwnode_endpoint vep;
|
||||
unsigned int i;
|
||||
int ret;
|
||||
bool csi1 = false;
|
||||
|
||||
ret = v4l2_fwnode_endpoint_parse(fwnode, &vep);
|
||||
if (ret)
|
||||
@ -2047,41 +2048,91 @@ static int isp_fwnode_parse(struct device *dev, struct fwnode_handle *fwnode,
|
||||
|
||||
case ISP_OF_PHY_CSIPHY1:
|
||||
case ISP_OF_PHY_CSIPHY2:
|
||||
/* FIXME: always assume CSI-2 for now. */
|
||||
switch (vep.bus_type) {
|
||||
case V4L2_MBUS_CCP2:
|
||||
case V4L2_MBUS_CSI1:
|
||||
dev_dbg(dev, "CSI-1/CCP-2 configuration\n");
|
||||
csi1 = true;
|
||||
break;
|
||||
case V4L2_MBUS_CSI2:
|
||||
dev_dbg(dev, "CSI-2 configuration\n");
|
||||
csi1 = false;
|
||||
break;
|
||||
default:
|
||||
dev_err(dev, "unsupported bus type %u\n",
|
||||
vep.bus_type);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
switch (vep.base.port) {
|
||||
case ISP_OF_PHY_CSIPHY1:
|
||||
buscfg->interface = ISP_INTERFACE_CSI2C_PHY1;
|
||||
if (csi1)
|
||||
buscfg->interface = ISP_INTERFACE_CCP2B_PHY1;
|
||||
else
|
||||
buscfg->interface = ISP_INTERFACE_CSI2C_PHY1;
|
||||
break;
|
||||
case ISP_OF_PHY_CSIPHY2:
|
||||
buscfg->interface = ISP_INTERFACE_CSI2A_PHY2;
|
||||
if (csi1)
|
||||
buscfg->interface = ISP_INTERFACE_CCP2B_PHY2;
|
||||
else
|
||||
buscfg->interface = ISP_INTERFACE_CSI2A_PHY2;
|
||||
break;
|
||||
}
|
||||
buscfg->bus.csi2.lanecfg.clk.pos = vep.bus.mipi_csi2.clock_lane;
|
||||
buscfg->bus.csi2.lanecfg.clk.pol =
|
||||
vep.bus.mipi_csi2.lane_polarities[0];
|
||||
dev_dbg(dev, "clock lane polarity %u, pos %u\n",
|
||||
buscfg->bus.csi2.lanecfg.clk.pol,
|
||||
buscfg->bus.csi2.lanecfg.clk.pos);
|
||||
if (csi1) {
|
||||
buscfg->bus.ccp2.lanecfg.clk.pos =
|
||||
vep.bus.mipi_csi1.clock_lane;
|
||||
buscfg->bus.ccp2.lanecfg.clk.pol =
|
||||
vep.bus.mipi_csi1.lane_polarity[0];
|
||||
dev_dbg(dev, "clock lane polarity %u, pos %u\n",
|
||||
buscfg->bus.ccp2.lanecfg.clk.pol,
|
||||
buscfg->bus.ccp2.lanecfg.clk.pos);
|
||||
|
||||
buscfg->bus.csi2.num_data_lanes =
|
||||
vep.bus.mipi_csi2.num_data_lanes;
|
||||
buscfg->bus.ccp2.lanecfg.data[0].pos =
|
||||
vep.bus.mipi_csi1.data_lane;
|
||||
buscfg->bus.ccp2.lanecfg.data[0].pol =
|
||||
vep.bus.mipi_csi1.lane_polarity[1];
|
||||
|
||||
for (i = 0; i < buscfg->bus.csi2.num_data_lanes; i++) {
|
||||
buscfg->bus.csi2.lanecfg.data[i].pos =
|
||||
vep.bus.mipi_csi2.data_lanes[i];
|
||||
buscfg->bus.csi2.lanecfg.data[i].pol =
|
||||
vep.bus.mipi_csi2.lane_polarities[i + 1];
|
||||
dev_dbg(dev, "data lane %u polarity %u, pos %u\n", i,
|
||||
buscfg->bus.csi2.lanecfg.data[i].pol,
|
||||
buscfg->bus.csi2.lanecfg.data[i].pos);
|
||||
}
|
||||
buscfg->bus.ccp2.lanecfg.data[0].pol,
|
||||
buscfg->bus.ccp2.lanecfg.data[0].pos);
|
||||
|
||||
/*
|
||||
* FIXME: now we assume the CRC is always there.
|
||||
* Implement a way to obtain this information from the
|
||||
* sensor. Frame descriptors, perhaps?
|
||||
*/
|
||||
buscfg->bus.csi2.crc = 1;
|
||||
buscfg->bus.ccp2.strobe_clk_pol =
|
||||
vep.bus.mipi_csi1.clock_inv;
|
||||
buscfg->bus.ccp2.phy_layer = vep.bus.mipi_csi1.strobe;
|
||||
buscfg->bus.ccp2.ccp2_mode =
|
||||
vep.bus_type == V4L2_MBUS_CCP2;
|
||||
buscfg->bus.ccp2.vp_clk_pol = 1;
|
||||
|
||||
buscfg->bus.ccp2.crc = 1;
|
||||
} else {
|
||||
buscfg->bus.csi2.lanecfg.clk.pos =
|
||||
vep.bus.mipi_csi2.clock_lane;
|
||||
buscfg->bus.csi2.lanecfg.clk.pol =
|
||||
vep.bus.mipi_csi2.lane_polarities[0];
|
||||
dev_dbg(dev, "clock lane polarity %u, pos %u\n",
|
||||
buscfg->bus.csi2.lanecfg.clk.pol,
|
||||
buscfg->bus.csi2.lanecfg.clk.pos);
|
||||
|
||||
buscfg->bus.csi2.num_data_lanes =
|
||||
vep.bus.mipi_csi2.num_data_lanes;
|
||||
|
||||
for (i = 0; i < buscfg->bus.csi2.num_data_lanes; i++) {
|
||||
buscfg->bus.csi2.lanecfg.data[i].pos =
|
||||
vep.bus.mipi_csi2.data_lanes[i];
|
||||
buscfg->bus.csi2.lanecfg.data[i].pol =
|
||||
vep.bus.mipi_csi2.lane_polarities[i + 1];
|
||||
dev_dbg(dev,
|
||||
"data lane %u polarity %u, pos %u\n", i,
|
||||
buscfg->bus.csi2.lanecfg.data[i].pol,
|
||||
buscfg->bus.csi2.lanecfg.data[i].pos);
|
||||
}
|
||||
/*
|
||||
* FIXME: now we assume the CRC is always there.
|
||||
* Implement a way to obtain this information from the
|
||||
* sensor. Frame descriptors, perhaps?
|
||||
*/
|
||||
buscfg->bus.csi2.crc = 1;
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
|
@ -110,6 +110,7 @@ struct isp_ccp2_cfg {
|
||||
unsigned int ccp2_mode:1;
|
||||
unsigned int phy_layer:1;
|
||||
unsigned int vpclk_div:2;
|
||||
unsigned int vp_clk_pol:1;
|
||||
struct isp_csiphy_lanes_cfg lanecfg;
|
||||
};
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user