Hi Sebastien, On Tue 11 Jun 2019 at 11:03, Sébastien Szymanski wrote: > On 6/11/19 11:40 AM, Rui Miguel Silva wrote: >> Hi Sebastien, >> On Tue 11 Jun 2019 at 09:16, Sébastien Szymanski wrote: >>> Hi Rui, >>> >>> thanks for the review! >>> >>> On 6/10/19 12:28 PM, Rui Miguel Silva wrote: >>>> Hi Sebastien, >>>> Thanks for the patch. >>>> >>>> On Thu 06 Jun 2019 at 16:38, Sébastien Szymanski wrote: >>>>> i.MX7 and i.MX6UL/L have the same CSI controller. So add i.MX6UL/L support >>>>> to imx7-media-csi driver. >>>>> >>>>> Signed-off-by: Sébastien Szymanski <sebastien.szymanski@xxxxxxxxxxxx> >>>>> --- >>>>> >>>>> Changes for v2: >>>>> - rebase on top of linuxtv/master >>>>> - mention i.MX6UL/L in header and Kconfig help text >>>>> - rename csi_type to csi_soc_id >>>>> >>>>> drivers/staging/media/imx/Kconfig | 4 +- >>>>> drivers/staging/media/imx/imx7-media-csi.c | 62 ++++++++++++++++------ >>>>> 2 files changed, 49 insertions(+), 17 deletions(-) >>>>> >>>>> diff --git a/drivers/staging/media/imx/Kconfig b/drivers/staging/media/imx/Kconfig >>>>> index ad3d7df6bb3c..8b6dc42c39e0 100644 >>>>> --- a/drivers/staging/media/imx/Kconfig >>>>> +++ b/drivers/staging/media/imx/Kconfig >>>>> @@ -22,11 +22,11 @@ config VIDEO_IMX_CSI >>>>> A video4linux camera sensor interface driver for i.MX5/6. >>>>> >>>>> config VIDEO_IMX7_CSI >>>>> - tristate "i.MX7 Camera Sensor Interface driver" >>>>> + tristate "i.MX6UL/L / i.MX7 Camera Sensor Interface driver" >>>>> depends on VIDEO_IMX_MEDIA && VIDEO_DEV && I2C >>>>> default y >>>>> help >>>>> Enable support for video4linux camera sensor interface driver for >>>>> - i.MX7. >>>>> + i.MX6UL/L or i.MX7. >>>>> endmenu >>>>> endif >>>>> diff --git a/drivers/staging/media/imx/imx7-media-csi.c b/drivers/staging/media/imx/imx7-media-csi.c >>>>> index 9101566f3f67..902bdce594cf 100644 >>>>> --- a/drivers/staging/media/imx/imx7-media-csi.c >>>>> +++ b/drivers/staging/media/imx/imx7-media-csi.c >>>>> @@ -1,6 +1,6 @@ >>>>> // SPDX-License-Identifier: GPL-2.0 >>>>> /* >>>>> - * V4L2 Capture CSI Subdev for Freescale i.MX7 SOC >>>>> + * V4L2 Capture CSI Subdev for Freescale i.MX6UL/L / i.MX7 SOC >>>>> * >>>>> * Copyright (c) 2019 Linaro Ltd >>>>> * >>>>> @@ -152,6 +152,11 @@ >>>>> #define CSI_CSICR18 0x48 >>>>> #define CSI_CSICR19 0x4c >>>>> >>>>> +enum csi_soc_id { >>>>> + IMX7, >>>>> + IMX6UL >>>>> +}; >>>>> + >>>>> struct imx7_csi { >>>>> struct device *dev; >>>>> struct v4l2_subdev sd; >>>>> @@ -191,6 +196,7 @@ struct imx7_csi { >>>>> bool is_init; >>>>> bool is_streaming; >>>>> bool is_csi2; >>>>> + enum csi_soc_id soc_id; >>>>> >>>>> struct completion last_eof_completion; >>>>> }; >>>>> @@ -548,6 +554,14 @@ static int imx7_csi_pad_link_validate(struct v4l2_subdev *sd, >>>>> if (ret) >>>>> return ret; >>>>> >>>>> + if (csi->soc_id == IMX6UL) { >>>>> + mutex_lock(&csi->lock); >>>>> + csi->is_csi2 = false; >>>>> + mutex_unlock(&csi->lock); >>>>> + >>>>> + return 0; >>>>> + } >>>>> + >>>>> ret = imx7_csi_get_upstream_endpoint(csi, &upstream_ep, true); >>>>> if (ret) { >>>>> v4l2_err(&csi->sd, "failed to find upstream endpoint\n"); >>>>> @@ -757,6 +771,7 @@ static int imx7_csi_configure(struct imx7_csi *csi) >>>>> struct v4l2_pix_format *out_pix = &vdev->fmt.fmt.pix; >>>>> __u32 in_code = csi->format_mbus[IMX7_CSI_PAD_SINK].code; >>>>> u32 cr1, cr18; >>>>> + int width = out_pix->width; >>>>> >>>>> if (out_pix->field == V4L2_FIELD_INTERLACED) { >>>>> imx7_csi_deinterlace_enable(csi, true); >>>>> @@ -766,15 +781,27 @@ static int imx7_csi_configure(struct imx7_csi *csi) >>>>> imx7_csi_buf_stride_set(csi, 0); >>>>> } >>>>> >>>>> - imx7_csi_set_imagpara(csi, out_pix->width, out_pix->height); >>>>> + cr18 = imx7_csi_reg_read(csi, CSI_CSICR18); >>>>> + >>>>> + if (!csi->is_csi2) { >>>>> + if (out_pix->pixelformat == V4L2_PIX_FMT_UYVY || >>>>> + out_pix->pixelformat == V4L2_PIX_FMT_YUYV) >>>>> + width *= 2; >>>>> + >>>>> + imx7_csi_set_imagpara(csi, width, out_pix->height); >>>>> + >>>>> + cr18 |= (BIT_BASEADDR_SWITCH_EN | BIT_BASEADDR_SWITCH_SEL | >>>>> + BIT_BASEADDR_CHG_ERR_EN); >>>>> + imx7_csi_reg_write(csi, cr18, CSI_CSICR18); >>>>> >>>>> - if (!csi->is_csi2) >>>>> return 0; >>>>> + } >>>>> + >>>>> + imx7_csi_set_imagpara(csi, width, out_pix->height); >>>>> >>>>> cr1 = imx7_csi_reg_read(csi, CSI_CSICR1); >>>>> cr1 &= ~BIT_GCLK_MODE; >>>>> >>>>> - cr18 = imx7_csi_reg_read(csi, CSI_CSICR18); >>>>> cr18 &= BIT_MIPI_DATA_FORMAT_MASK; >>>>> cr18 |= BIT_DATA_FROM_MIPI; >>>>> >>>>> @@ -809,11 +836,9 @@ static void imx7_csi_enable(struct imx7_csi *csi) >>>>> { >>>>> imx7_csi_sw_reset(csi); >>>>> >>>>> - if (csi->is_csi2) { >>>>> - imx7_csi_dmareq_rff_enable(csi); >>>>> - imx7_csi_hw_enable_irq(csi); >>>>> - imx7_csi_hw_enable(csi); >>>>> - } >>>>> + imx7_csi_dmareq_rff_enable(csi); >>>>> + imx7_csi_hw_enable_irq(csi); >>>>> + imx7_csi_hw_enable(csi); >>>>> } >>>>> >>>>> static void imx7_csi_disable(struct imx7_csi *csi) >>>>> @@ -1166,19 +1191,32 @@ static int imx7_csi_parse_endpoint(struct device *dev, >>>>> return fwnode_device_is_available(asd->match.fwnode) ? 0 : -EINVAL; >>>>> } >>>>> >>>>> +static const struct of_device_id imx7_csi_of_match[] = { >>>>> + { .compatible = "fsl,imx7-csi", .data = (void *)IMX7 }, >>>>> + { .compatible = "fsl,imx6ul-csi", .data = (void *)IMX6UL }, >>>> >>>> looking at this again I think we can do this is a different way. >>>> Instead data being the soc_id, just set here if it is_csi2 or not. >>>> >>>> This would avoid to add a soc_id to the struct that it really it >>>> is used only to setup the is_csi2 var. I think this will make this >>>> patch a lot simpler. >>> >>> Well, I have added this soc_id because imx7_csi_get_upstream_endpoint in >>> imx7_csi_pad_link_validate fails: >>> >>> [ 366.549768] csi: failed to find upstream endpoint >>> [ 366.556274] csi: pipeline start failed with -19 >>> >> >> I think this fails because you do not define any endpoint for the >> csi in your board dts file. I see in patch 1/3 the setup of csi, >> disabled, but not the endpoint connecting csi with the ov5640 in >> your board file (see the connection between mipi imx7 and ov2680 >> in the imx7-warp.dts, or the ov5640.txt file). > > I actually do, in the device tree of my board I have: Yeah, I thought you did this, because if not it did not work in the first place. I will take a look at why the fetch of the upstream endpoint is not working. it should :). Thanks for the feedback. I will let you know. --- Cheers, Rui > > &csi { > pinctrl-names = "default"; > pinctrl-0 = <&pinctrl_csi>; > status = "okay"; > > port { > csi_ep: endpoint { > remote-endpoint = <&ov5640_ep>; > bus-type = <5>; // V4L2_FWNODE_BUS_TYPE_PARALLEL > }; > }; > }; > > and > > &i2c2 { > .. > ov5640: camera@3c { > ... > port { > ov5640_ep: endpoint { > remote-endpoint = <&csi_ep>; > bus-width = <8>; > data-shift = <2>; /* lines 9:2 are used */ > hsync-active = <0>; > vsync-active = <1>; > pclk-sample = <0>; > }; > }; > }; > }; > > Regards,