Message ID | 1596465107-14251-3-git-send-email-prabhakar.mahadev-lad.rj@bp.renesas.com (mailing list archive) |
---|---|
State | Superseded |
Delegated to: | Kieran Bingham |
Headers | show |
Series | media: i2c: ov5640 feature enhancement and fixes | expand |
Hi Prabhakar, On Mon, Aug 03, 2020 at 03:31:45PM +0100, Lad Prabhakar wrote: > During testing this sensor on iW-RainboW-G21D-Qseven platform in 8-bit DVP > mode with rcar-vin bridge noticed the capture worked fine for the first run > (with yavta), but for subsequent runs the bridge driver waited for the > frame to be captured. Debugging further noticed the data lines were > enabled/disabled in stream on/off callback and dumping the register > contents 0x3017/0x3018 in ov5640_set_stream_dvp() reported the correct > values, but yet frame capturing failed. That's pretty weird, I wonder if that's not an issue in the bridge, as I expect someone tryed to capture more than 1 image in DVP mode with this driver already. I didn't get from your commit message if you have been able to identify where the issue is. You said register values are correct, but did you try to plug a scope and see if data are actually put on the bus ? Does this happen with full parallel too or BT.656 only ? > > To get around this issue the following actions are performed for > parallel mode (DVP): > 1: Keeps the sensor in software power down mode and is woken up only in > ov5640_set_stream_dvp() callback. > 2: Enables data lines in s_power callback > 3: Configures HVP lines in s_power callback instead of configuring > everytime in ov5640_set_stream_dvp(). > 4: Disables MIPI interface. > > Fixes: f22996db44e2d ("media: ov5640: add support of DVP parallel interface") > Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com> > Reviewed-by: Biju Das <biju.das.jz@bp.renesas.com> > --- > drivers/media/i2c/ov5640.c | 321 ++++++++++++++++++++----------------- > 1 file changed, 172 insertions(+), 149 deletions(-) > > diff --git a/drivers/media/i2c/ov5640.c b/drivers/media/i2c/ov5640.c > index 2fe4a7ac0592..ec444bee2ce9 100644 > --- a/drivers/media/i2c/ov5640.c > +++ b/drivers/media/i2c/ov5640.c > @@ -94,6 +94,9 @@ > #define OV5640_REG_SDE_CTRL5 0x5585 > #define OV5640_REG_AVG_READOUT 0x56a1 > > +#define OV5640_SOFTWARE_PWDN 0x42 > +#define OV5640_SOFTWARE_WAKEUP 0x02 > + > enum ov5640_mode_id { > OV5640_MODE_QCIF_176_144 = 0, > OV5640_MODE_QVGA_320_240, > @@ -274,7 +277,7 @@ static inline struct v4l2_subdev *ctrl_to_sd(struct v4l2_ctrl *ctrl) > /* YUV422 UYVY VGA@30fps */ > static const struct reg_value ov5640_init_setting_30fps_VGA[] = { > {0x3103, 0x11, 0, 0}, {0x3008, 0x82, 0, 5}, {0x3008, 0x42, 0, 0}, > - {0x3103, 0x03, 0, 0}, {0x3017, 0x00, 0, 0}, {0x3018, 0x00, 0, 0}, > + {0x3103, 0x03, 0, 0}, > {0x3630, 0x36, 0, 0}, > {0x3631, 0x0e, 0, 0}, {0x3632, 0xe2, 0, 0}, {0x3633, 0x12, 0, 0}, > {0x3621, 0xe0, 0, 0}, {0x3704, 0xa0, 0, 0}, {0x3703, 0x5a, 0, 0}, > @@ -1120,6 +1123,11 @@ static int ov5640_load_regs(struct ov5640_dev *sensor, > val = regs->val; > mask = regs->mask; > > + /* remain in power down mode for DVP */ > + if (regs->reg_addr == OV5640_REG_SYS_CTRL0 && val == OV5640_SOFTWARE_WAKEUP && > + sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > + continue; > + > if (mask) > ret = ov5640_mod_reg(sensor, reg_addr, mask, val); > else > @@ -1210,96 +1218,8 @@ static int ov5640_set_autogain(struct ov5640_dev *sensor, bool on) > > static int ov5640_set_stream_dvp(struct ov5640_dev *sensor, bool on) > { > - int ret; > - unsigned int flags = sensor->ep.bus.parallel.flags; > - u8 pclk_pol = 0; > - u8 hsync_pol = 0; > - u8 vsync_pol = 0; > - > - /* > - * Note about parallel port configuration. > - * > - * When configured in parallel mode, the OV5640 will > - * output 10 bits data on DVP data lines [9:0]. > - * If only 8 bits data are wanted, the 8 bits data lines > - * of the camera interface must be physically connected > - * on the DVP data lines [9:2]. > - * > - * Control lines polarity can be configured through > - * devicetree endpoint control lines properties. > - * If no endpoint control lines properties are set, > - * polarity will be as below: > - * - VSYNC: active high > - * - HREF: active low > - * - PCLK: active low > - */ > - > - if (on) { > - /* > - * configure parallel port control lines polarity > - * > - * POLARITY CTRL0 > - * - [5]: PCLK polarity (0: active low, 1: active high) > - * - [1]: HREF polarity (0: active low, 1: active high) > - * - [0]: VSYNC polarity (mismatch here between > - * datasheet and hardware, 0 is active high > - * and 1 is active low...) > - */ > - if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > - pclk_pol = 1; > - if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > - hsync_pol = 1; > - if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > - vsync_pol = 1; > - > - ret = ov5640_write_reg(sensor, > - OV5640_REG_POLARITY_CTRL00, > - (pclk_pol << 5) | > - (hsync_pol << 1) | > - vsync_pol); > - > - if (ret) > - return ret; > - } > - > - /* > - * powerdown MIPI TX/RX PHY & disable MIPI > - * > - * MIPI CONTROL 00 > - * 4: PWDN PHY TX > - * 3: PWDN PHY RX > - * 2: MIPI enable > - */ > - ret = ov5640_write_reg(sensor, > - OV5640_REG_IO_MIPI_CTRL00, on ? 0x18 : 0); > - if (ret) > - return ret; > - > - /* > - * enable VSYNC/HREF/PCLK DVP control lines > - * & D[9:6] DVP data lines > - * > - * PAD OUTPUT ENABLE 01 > - * - 6: VSYNC output enable > - * - 5: HREF output enable > - * - 4: PCLK output enable > - * - [3:0]: D[9:6] output enable > - */ > - ret = ov5640_write_reg(sensor, > - OV5640_REG_PAD_OUTPUT_ENABLE01, > - on ? 0x7f : 0); > - if (ret) > - return ret; > - > - /* > - * enable D[5:0] DVP data lines > - * > - * PAD OUTPUT ENABLE 02 > - * - [7:2]: D[5:0] output enable > - */ > - return ov5640_write_reg(sensor, > - OV5640_REG_PAD_OUTPUT_ENABLE02, > - on ? 0xfc : 0); > + return ov5640_write_reg(sensor, OV5640_REG_SYS_CTRL0, on ? > + OV5640_SOFTWARE_WAKEUP : OV5640_SOFTWARE_PWDN); > } > > static int ov5640_set_stream_mipi(struct ov5640_dev *sensor, bool on) > @@ -2001,6 +1921,159 @@ static void ov5640_set_power_off(struct ov5640_dev *sensor) > clk_disable_unprepare(sensor->xclk); > } > > +static int ov5640_set_mipi(struct ov5640_dev *sensor, bool on) > +{ > + int ret = 0; > + > + if (!on) { > + /* Reset MIPI bus settings to their default values. */ > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > + ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x04); > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x00); > + > + return ret; > + } > + > + /* > + * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > + * > + * 0x300e = 0x40 > + * [7:5] = 010 : 2 data lanes mode (see FIXME note in > + * "ov5640_set_stream_mipi()") > + * [4] = 0 : Power up MIPI HS Tx > + * [3] = 0 : Power up MIPI LS Rx > + * [2] = 0 : MIPI interface disabled > + */ > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x40); > + if (ret) > + return ret; > + > + /* > + * Gate clock and set LP11 in 'no packets mode' (idle) > + * > + * 0x4800 = 0x24 > + * [5] = 1 : Gate clock when 'no packets' > + * [2] = 1 : MIPI bus in LP11 when 'no packets' > + */ > + ret = ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x24); > + if (ret) > + return ret; > + > + /* > + * Set data lanes and clock in LP11 when 'sleeping' > + * > + * 0x3019 = 0x70 > + * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > + * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > + * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > + */ > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x70); > + if (ret) > + return ret; > + > + /* Give lanes some time to coax into LP11 state. */ > + usleep_range(500, 1000); > + > + return 0; > +} > + > +static int ov5640_set_dvp(struct ov5640_dev *sensor, bool on) > +{ > + unsigned int flags = sensor->ep.bus.parallel.flags; > + u8 pclk_pol = 0; > + u8 hsync_pol = 0; > + u8 vsync_pol = 0; > + int ret = 0; > + > + if (!on) { > + /* Reset settings to their default values. */ > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > + ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, 0x20); > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x00); > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0x00); > + > + return ret; > + } > + > + /* > + * Note about parallel port configuration. > + * > + * When configured in parallel mode, the OV5640 will > + * output 10 bits data on DVP data lines [9:0]. > + * If only 8 bits data are wanted, the 8 bits data lines > + * of the camera interface must be physically connected > + * on the DVP data lines [9:2]. > + * > + * Control lines polarity can be configured through > + * devicetree endpoint control lines properties. > + * If no endpoint control lines properties are set, > + * polarity will be as below: > + * - VSYNC: active high > + * - HREF: active low > + * - PCLK: active low > + */ > + /* > + * configure parallel port control lines polarity > + * > + * POLARITY CTRL0 > + * - [5]: PCLK polarity (0: active low, 1: active high) > + * - [1]: HREF polarity (0: active low, 1: active high) > + * - [0]: VSYNC polarity (mismatch here between > + * datasheet and hardware, 0 is active high > + * and 1 is active low...) > + */ > + if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > + pclk_pol = 1; > + if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > + hsync_pol = 1; > + if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > + vsync_pol = 1; > + > + ret = ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, > + (pclk_pol << 5) | (hsync_pol << 1) | vsync_pol); > + > + if (ret) > + return ret; > + > + /* > + * powerdown MIPI TX/RX PHY & disable MIPI > + * > + * MIPI CONTROL 00 > + * 4: PWDN PHY TX > + * 3: PWDN PHY RX > + * 2: MIPI enable > + */ > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x18); > + if (ret) > + return ret; > + > + /* > + * enable VSYNC/HREF/PCLK DVP control lines > + * & D[9:6] DVP data lines > + * > + * PAD OUTPUT ENABLE 01 > + * - 6: VSYNC output enable > + * - 5: HREF output enable > + * - 4: PCLK output enable > + * - [3:0]: D[9:6] output enable > + */ > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x7f); > + if (ret) > + return ret; > + > + /* > + * enable D[5:0] DVP data lines > + * > + * PAD OUTPUT ENABLE 02 > + * - [7:2]: D[5:0] output enable > + */ > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0xfc); > + if (ret) > + return ret; > + > + return 0; > +} > + > static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > { > int ret = 0; > @@ -2013,67 +2086,17 @@ static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > ret = ov5640_restore_mode(sensor); > if (ret) > goto power_off; > + } > > - /* We're done here for DVP bus, while CSI-2 needs setup. */ > - if (sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > - return 0; > - > - /* > - * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > - * > - * 0x300e = 0x40 > - * [7:5] = 010 : 2 data lanes mode (see FIXME note in > - * "ov5640_set_stream_mipi()") > - * [4] = 0 : Power up MIPI HS Tx > - * [3] = 0 : Power up MIPI LS Rx > - * [2] = 0 : MIPI interface disabled > - */ > - ret = ov5640_write_reg(sensor, > - OV5640_REG_IO_MIPI_CTRL00, 0x40); > - if (ret) > - goto power_off; > - > - /* > - * Gate clock and set LP11 in 'no packets mode' (idle) > - * > - * 0x4800 = 0x24 > - * [5] = 1 : Gate clock when 'no packets' > - * [2] = 1 : MIPI bus in LP11 when 'no packets' > - */ > - ret = ov5640_write_reg(sensor, > - OV5640_REG_MIPI_CTRL00, 0x24); > - if (ret) > - goto power_off; > - > - /* > - * Set data lanes and clock in LP11 when 'sleeping' > - * > - * 0x3019 = 0x70 > - * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > - * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > - * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > - */ > - ret = ov5640_write_reg(sensor, > - OV5640_REG_PAD_OUTPUT00, 0x70); > - if (ret) > - goto power_off; > - > - /* Give lanes some time to coax into LP11 state. */ > - usleep_range(500, 1000); > - > - } else { > - if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) { > - /* Reset MIPI bus settings to their default values. */ > - ov5640_write_reg(sensor, > - OV5640_REG_IO_MIPI_CTRL00, 0x58); > - ov5640_write_reg(sensor, > - OV5640_REG_MIPI_CTRL00, 0x04); > - ov5640_write_reg(sensor, > - OV5640_REG_PAD_OUTPUT00, 0x00); > - } > + if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) > + ret = ov5640_set_mipi(sensor, on); > + else > + ret = ov5640_set_dvp(sensor, on); > + if (ret) > + goto power_off; > > + if (!on) > ov5640_set_power_off(sensor); > - } > > return 0; > > -- > 2.17.1 >
Hi Jacopo, Thank you for the review. On Thu, Aug 6, 2020 at 5:27 PM Jacopo Mondi <jacopo@jmondi.org> wrote: > > Hi Prabhakar, > > On Mon, Aug 03, 2020 at 03:31:45PM +0100, Lad Prabhakar wrote: > > During testing this sensor on iW-RainboW-G21D-Qseven platform in 8-bit DVP > > mode with rcar-vin bridge noticed the capture worked fine for the first run > > (with yavta), but for subsequent runs the bridge driver waited for the > > frame to be captured. Debugging further noticed the data lines were > > enabled/disabled in stream on/off callback and dumping the register > > contents 0x3017/0x3018 in ov5640_set_stream_dvp() reported the correct > > values, but yet frame capturing failed. > > That's pretty weird, I wonder if that's not an issue in the bridge, as > I expect someone tryed to capture more than 1 image in DVP mode with > this driver already. > I did try the bridge driver with an ov7725 sensor and it works fine in both the modes (DVP and BT656). > I didn't get from your commit message if you have been able to > identify where the issue is. You said register values are correct, but > did you try to plug a scope and see if data are actually put on the > bus ? Does this happen with full parallel too or BT.656 only ? > unfortunately I didn't scope the pins, but this issue happened in both the modes. And with this patch it improves handling the sensor in s_stream call. Cheers, Prabhakar > > > > To get around this issue the following actions are performed for > > parallel mode (DVP): > > 1: Keeps the sensor in software power down mode and is woken up only in > > ov5640_set_stream_dvp() callback. > > 2: Enables data lines in s_power callback > > 3: Configures HVP lines in s_power callback instead of configuring > > everytime in ov5640_set_stream_dvp(). > > 4: Disables MIPI interface. > > > > Fixes: f22996db44e2d ("media: ov5640: add support of DVP parallel interface") > > Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com> > > Reviewed-by: Biju Das <biju.das.jz@bp.renesas.com> > > --- > > drivers/media/i2c/ov5640.c | 321 ++++++++++++++++++++----------------- > > 1 file changed, 172 insertions(+), 149 deletions(-) > > > > diff --git a/drivers/media/i2c/ov5640.c b/drivers/media/i2c/ov5640.c > > index 2fe4a7ac0592..ec444bee2ce9 100644 > > --- a/drivers/media/i2c/ov5640.c > > +++ b/drivers/media/i2c/ov5640.c > > @@ -94,6 +94,9 @@ > > #define OV5640_REG_SDE_CTRL5 0x5585 > > #define OV5640_REG_AVG_READOUT 0x56a1 > > > > +#define OV5640_SOFTWARE_PWDN 0x42 > > +#define OV5640_SOFTWARE_WAKEUP 0x02 > > + > > enum ov5640_mode_id { > > OV5640_MODE_QCIF_176_144 = 0, > > OV5640_MODE_QVGA_320_240, > > @@ -274,7 +277,7 @@ static inline struct v4l2_subdev *ctrl_to_sd(struct v4l2_ctrl *ctrl) > > /* YUV422 UYVY VGA@30fps */ > > static const struct reg_value ov5640_init_setting_30fps_VGA[] = { > > {0x3103, 0x11, 0, 0}, {0x3008, 0x82, 0, 5}, {0x3008, 0x42, 0, 0}, > > - {0x3103, 0x03, 0, 0}, {0x3017, 0x00, 0, 0}, {0x3018, 0x00, 0, 0}, > > + {0x3103, 0x03, 0, 0}, > > {0x3630, 0x36, 0, 0}, > > {0x3631, 0x0e, 0, 0}, {0x3632, 0xe2, 0, 0}, {0x3633, 0x12, 0, 0}, > > {0x3621, 0xe0, 0, 0}, {0x3704, 0xa0, 0, 0}, {0x3703, 0x5a, 0, 0}, > > @@ -1120,6 +1123,11 @@ static int ov5640_load_regs(struct ov5640_dev *sensor, > > val = regs->val; > > mask = regs->mask; > > > > + /* remain in power down mode for DVP */ > > + if (regs->reg_addr == OV5640_REG_SYS_CTRL0 && val == OV5640_SOFTWARE_WAKEUP && > > + sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > + continue; > > + > > if (mask) > > ret = ov5640_mod_reg(sensor, reg_addr, mask, val); > > else > > @@ -1210,96 +1218,8 @@ static int ov5640_set_autogain(struct ov5640_dev *sensor, bool on) > > > > static int ov5640_set_stream_dvp(struct ov5640_dev *sensor, bool on) > > { > > - int ret; > > - unsigned int flags = sensor->ep.bus.parallel.flags; > > - u8 pclk_pol = 0; > > - u8 hsync_pol = 0; > > - u8 vsync_pol = 0; > > - > > - /* > > - * Note about parallel port configuration. > > - * > > - * When configured in parallel mode, the OV5640 will > > - * output 10 bits data on DVP data lines [9:0]. > > - * If only 8 bits data are wanted, the 8 bits data lines > > - * of the camera interface must be physically connected > > - * on the DVP data lines [9:2]. > > - * > > - * Control lines polarity can be configured through > > - * devicetree endpoint control lines properties. > > - * If no endpoint control lines properties are set, > > - * polarity will be as below: > > - * - VSYNC: active high > > - * - HREF: active low > > - * - PCLK: active low > > - */ > > - > > - if (on) { > > - /* > > - * configure parallel port control lines polarity > > - * > > - * POLARITY CTRL0 > > - * - [5]: PCLK polarity (0: active low, 1: active high) > > - * - [1]: HREF polarity (0: active low, 1: active high) > > - * - [0]: VSYNC polarity (mismatch here between > > - * datasheet and hardware, 0 is active high > > - * and 1 is active low...) > > - */ > > - if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > - pclk_pol = 1; > > - if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > - hsync_pol = 1; > > - if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > - vsync_pol = 1; > > - > > - ret = ov5640_write_reg(sensor, > > - OV5640_REG_POLARITY_CTRL00, > > - (pclk_pol << 5) | > > - (hsync_pol << 1) | > > - vsync_pol); > > - > > - if (ret) > > - return ret; > > - } > > - > > - /* > > - * powerdown MIPI TX/RX PHY & disable MIPI > > - * > > - * MIPI CONTROL 00 > > - * 4: PWDN PHY TX > > - * 3: PWDN PHY RX > > - * 2: MIPI enable > > - */ > > - ret = ov5640_write_reg(sensor, > > - OV5640_REG_IO_MIPI_CTRL00, on ? 0x18 : 0); > > - if (ret) > > - return ret; > > - > > - /* > > - * enable VSYNC/HREF/PCLK DVP control lines > > - * & D[9:6] DVP data lines > > - * > > - * PAD OUTPUT ENABLE 01 > > - * - 6: VSYNC output enable > > - * - 5: HREF output enable > > - * - 4: PCLK output enable > > - * - [3:0]: D[9:6] output enable > > - */ > > - ret = ov5640_write_reg(sensor, > > - OV5640_REG_PAD_OUTPUT_ENABLE01, > > - on ? 0x7f : 0); > > - if (ret) > > - return ret; > > - > > - /* > > - * enable D[5:0] DVP data lines > > - * > > - * PAD OUTPUT ENABLE 02 > > - * - [7:2]: D[5:0] output enable > > - */ > > - return ov5640_write_reg(sensor, > > - OV5640_REG_PAD_OUTPUT_ENABLE02, > > - on ? 0xfc : 0); > > + return ov5640_write_reg(sensor, OV5640_REG_SYS_CTRL0, on ? > > + OV5640_SOFTWARE_WAKEUP : OV5640_SOFTWARE_PWDN); > > } > > > > static int ov5640_set_stream_mipi(struct ov5640_dev *sensor, bool on) > > @@ -2001,6 +1921,159 @@ static void ov5640_set_power_off(struct ov5640_dev *sensor) > > clk_disable_unprepare(sensor->xclk); > > } > > > > +static int ov5640_set_mipi(struct ov5640_dev *sensor, bool on) > > +{ > > + int ret = 0; > > + > > + if (!on) { > > + /* Reset MIPI bus settings to their default values. */ > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > + ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x04); > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x00); > > + > > + return ret; > > + } > > + > > + /* > > + * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > + * > > + * 0x300e = 0x40 > > + * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > + * "ov5640_set_stream_mipi()") > > + * [4] = 0 : Power up MIPI HS Tx > > + * [3] = 0 : Power up MIPI LS Rx > > + * [2] = 0 : MIPI interface disabled > > + */ > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x40); > > + if (ret) > > + return ret; > > + > > + /* > > + * Gate clock and set LP11 in 'no packets mode' (idle) > > + * > > + * 0x4800 = 0x24 > > + * [5] = 1 : Gate clock when 'no packets' > > + * [2] = 1 : MIPI bus in LP11 when 'no packets' > > + */ > > + ret = ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x24); > > + if (ret) > > + return ret; > > + > > + /* > > + * Set data lanes and clock in LP11 when 'sleeping' > > + * > > + * 0x3019 = 0x70 > > + * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > + * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > + * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > + */ > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x70); > > + if (ret) > > + return ret; > > + > > + /* Give lanes some time to coax into LP11 state. */ > > + usleep_range(500, 1000); > > + > > + return 0; > > +} > > + > > +static int ov5640_set_dvp(struct ov5640_dev *sensor, bool on) > > +{ > > + unsigned int flags = sensor->ep.bus.parallel.flags; > > + u8 pclk_pol = 0; > > + u8 hsync_pol = 0; > > + u8 vsync_pol = 0; > > + int ret = 0; > > + > > + if (!on) { > > + /* Reset settings to their default values. */ > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > + ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, 0x20); > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x00); > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0x00); > > + > > + return ret; > > + } > > + > > + /* > > + * Note about parallel port configuration. > > + * > > + * When configured in parallel mode, the OV5640 will > > + * output 10 bits data on DVP data lines [9:0]. > > + * If only 8 bits data are wanted, the 8 bits data lines > > + * of the camera interface must be physically connected > > + * on the DVP data lines [9:2]. > > + * > > + * Control lines polarity can be configured through > > + * devicetree endpoint control lines properties. > > + * If no endpoint control lines properties are set, > > + * polarity will be as below: > > + * - VSYNC: active high > > + * - HREF: active low > > + * - PCLK: active low > > + */ > > + /* > > + * configure parallel port control lines polarity > > + * > > + * POLARITY CTRL0 > > + * - [5]: PCLK polarity (0: active low, 1: active high) > > + * - [1]: HREF polarity (0: active low, 1: active high) > > + * - [0]: VSYNC polarity (mismatch here between > > + * datasheet and hardware, 0 is active high > > + * and 1 is active low...) > > + */ > > + if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > + pclk_pol = 1; > > + if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > + hsync_pol = 1; > > + if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > + vsync_pol = 1; > > + > > + ret = ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, > > + (pclk_pol << 5) | (hsync_pol << 1) | vsync_pol); > > + > > + if (ret) > > + return ret; > > + > > + /* > > + * powerdown MIPI TX/RX PHY & disable MIPI > > + * > > + * MIPI CONTROL 00 > > + * 4: PWDN PHY TX > > + * 3: PWDN PHY RX > > + * 2: MIPI enable > > + */ > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x18); > > + if (ret) > > + return ret; > > + > > + /* > > + * enable VSYNC/HREF/PCLK DVP control lines > > + * & D[9:6] DVP data lines > > + * > > + * PAD OUTPUT ENABLE 01 > > + * - 6: VSYNC output enable > > + * - 5: HREF output enable > > + * - 4: PCLK output enable > > + * - [3:0]: D[9:6] output enable > > + */ > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x7f); > > + if (ret) > > + return ret; > > + > > + /* > > + * enable D[5:0] DVP data lines > > + * > > + * PAD OUTPUT ENABLE 02 > > + * - [7:2]: D[5:0] output enable > > + */ > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0xfc); > > + if (ret) > > + return ret; > > + > > + return 0; > > +} > > + > > static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > { > > int ret = 0; > > @@ -2013,67 +2086,17 @@ static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > ret = ov5640_restore_mode(sensor); > > if (ret) > > goto power_off; > > + } > > > > - /* We're done here for DVP bus, while CSI-2 needs setup. */ > > - if (sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > - return 0; > > - > > - /* > > - * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > - * > > - * 0x300e = 0x40 > > - * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > - * "ov5640_set_stream_mipi()") > > - * [4] = 0 : Power up MIPI HS Tx > > - * [3] = 0 : Power up MIPI LS Rx > > - * [2] = 0 : MIPI interface disabled > > - */ > > - ret = ov5640_write_reg(sensor, > > - OV5640_REG_IO_MIPI_CTRL00, 0x40); > > - if (ret) > > - goto power_off; > > - > > - /* > > - * Gate clock and set LP11 in 'no packets mode' (idle) > > - * > > - * 0x4800 = 0x24 > > - * [5] = 1 : Gate clock when 'no packets' > > - * [2] = 1 : MIPI bus in LP11 when 'no packets' > > - */ > > - ret = ov5640_write_reg(sensor, > > - OV5640_REG_MIPI_CTRL00, 0x24); > > - if (ret) > > - goto power_off; > > - > > - /* > > - * Set data lanes and clock in LP11 when 'sleeping' > > - * > > - * 0x3019 = 0x70 > > - * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > - * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > - * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > - */ > > - ret = ov5640_write_reg(sensor, > > - OV5640_REG_PAD_OUTPUT00, 0x70); > > - if (ret) > > - goto power_off; > > - > > - /* Give lanes some time to coax into LP11 state. */ > > - usleep_range(500, 1000); > > - > > - } else { > > - if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) { > > - /* Reset MIPI bus settings to their default values. */ > > - ov5640_write_reg(sensor, > > - OV5640_REG_IO_MIPI_CTRL00, 0x58); > > - ov5640_write_reg(sensor, > > - OV5640_REG_MIPI_CTRL00, 0x04); > > - ov5640_write_reg(sensor, > > - OV5640_REG_PAD_OUTPUT00, 0x00); > > - } > > + if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) > > + ret = ov5640_set_mipi(sensor, on); > > + else > > + ret = ov5640_set_dvp(sensor, on); > > + if (ret) > > + goto power_off; > > > > + if (!on) > > ov5640_set_power_off(sensor); > > - } > > > > return 0; > > > > -- > > 2.17.1 > >
Hi Prabhakar, + Paul who is working with this chip on a parallel setup On Thu, Aug 06, 2020 at 05:38:57PM +0100, Lad, Prabhakar wrote: > Hi Jacopo, > > Thank you for the review. > > On Thu, Aug 6, 2020 at 5:27 PM Jacopo Mondi <jacopo@jmondi.org> wrote: > > > > Hi Prabhakar, > > > > On Mon, Aug 03, 2020 at 03:31:45PM +0100, Lad Prabhakar wrote: > > > During testing this sensor on iW-RainboW-G21D-Qseven platform in 8-bit DVP > > > mode with rcar-vin bridge noticed the capture worked fine for the first run > > > (with yavta), but for subsequent runs the bridge driver waited for the > > > frame to be captured. Debugging further noticed the data lines were > > > enabled/disabled in stream on/off callback and dumping the register > > > contents 0x3017/0x3018 in ov5640_set_stream_dvp() reported the correct > > > values, but yet frame capturing failed. > > > > That's pretty weird, I wonder if that's not an issue in the bridge, as > > I expect someone tryed to capture more than 1 image in DVP mode with > > this driver already. > > > I did try the bridge driver with an ov7725 sensor and it works fine in > both the modes (DVP and BT656). > > > I didn't get from your commit message if you have been able to > > identify where the issue is. You said register values are correct, but > > did you try to plug a scope and see if data are actually put on the > > bus ? Does this happen with full parallel too or BT.656 only ? > > > unfortunately I didn't scope the pins, but this issue happened in both > the modes. And with this patch it improves handling the sensor in > s_stream call. > For the record, I tested this one with my CSI-2 setup and capture still works as expected. > Cheers, > Prabhakar > > > > > > > To get around this issue the following actions are performed for > > > parallel mode (DVP): > > > 1: Keeps the sensor in software power down mode and is woken up only in > > > ov5640_set_stream_dvp() callback. > > > 2: Enables data lines in s_power callback > > > 3: Configures HVP lines in s_power callback instead of configuring > > > everytime in ov5640_set_stream_dvp(). > > > 4: Disables MIPI interface. > > > > > > Fixes: f22996db44e2d ("media: ov5640: add support of DVP parallel interface") > > > Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com> > > > Reviewed-by: Biju Das <biju.das.jz@bp.renesas.com> > > > --- > > > drivers/media/i2c/ov5640.c | 321 ++++++++++++++++++++----------------- > > > 1 file changed, 172 insertions(+), 149 deletions(-) > > > > > > diff --git a/drivers/media/i2c/ov5640.c b/drivers/media/i2c/ov5640.c > > > index 2fe4a7ac0592..ec444bee2ce9 100644 > > > --- a/drivers/media/i2c/ov5640.c > > > +++ b/drivers/media/i2c/ov5640.c > > > @@ -94,6 +94,9 @@ > > > #define OV5640_REG_SDE_CTRL5 0x5585 > > > #define OV5640_REG_AVG_READOUT 0x56a1 > > > > > > +#define OV5640_SOFTWARE_PWDN 0x42 > > > +#define OV5640_SOFTWARE_WAKEUP 0x02 These two are bitmasks to apply to register 0x3008. I would place them below the register definition and name them: #define OV5640_REG_SYS_CTRL0_SW_PWDN 0x42 #define OV5640_REG_SYS_CTRL0_SW_PWUP 0x02 or even: #define OV5640_REG_SYS_CTRL0_SW_POWER(on) (0x2 | (on ? 0x40 : 0x00)) Up to you, but I would keep them close to the register definition. > > > + > > > enum ov5640_mode_id { > > > OV5640_MODE_QCIF_176_144 = 0, > > > OV5640_MODE_QVGA_320_240, > > > @@ -274,7 +277,7 @@ static inline struct v4l2_subdev *ctrl_to_sd(struct v4l2_ctrl *ctrl) > > > /* YUV422 UYVY VGA@30fps */ > > > static const struct reg_value ov5640_init_setting_30fps_VGA[] = { > > > {0x3103, 0x11, 0, 0}, {0x3008, 0x82, 0, 5}, {0x3008, 0x42, 0, 0}, > > > - {0x3103, 0x03, 0, 0}, {0x3017, 0x00, 0, 0}, {0x3018, 0x00, 0, 0}, > > > + {0x3103, 0x03, 0, 0}, > > > {0x3630, 0x36, 0, 0}, Could you reflow this lines to not leave holes ? > > > {0x3631, 0x0e, 0, 0}, {0x3632, 0xe2, 0, 0}, {0x3633, 0x12, 0, 0}, > > > {0x3621, 0xe0, 0, 0}, {0x3704, 0xa0, 0, 0}, {0x3703, 0x5a, 0, 0}, > > > @@ -1120,6 +1123,11 @@ static int ov5640_load_regs(struct ov5640_dev *sensor, > > > val = regs->val; > > > mask = regs->mask; > > > > > > + /* remain in power down mode for DVP */ > > > + if (regs->reg_addr == OV5640_REG_SYS_CTRL0 && val == OV5640_SOFTWARE_WAKEUP && > > > + sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > > + continue; > > > + I'm not yet convinced this is a good idea. This will cause the ov5640_set_dvp() function to be called while the chip is still in 'software power-down' mode. I tried to do the same for CSI-2 as well and indeed I have LP-11 errors from the CSI-2 receiver, but then capture works fine (puzzling! it might indicate that register values as actually retained between software power up/down) This driver is such a mess I won't mind this 'special' dvp handling, but it really puzzles me. From what I see here the bulk of this patch is about moving the parallel bus configuration from s_stream() to s_power(), is this bit here really required for that to work or is it a leftover ? Have you tested it without the above hunk ? Paul, would you be able to test this series with your parallel setup as well ? Also, if not strictly necessary, let's try to remain in the 80 cols limit. > > > if (mask) > > > ret = ov5640_mod_reg(sensor, reg_addr, mask, val); > > > else > > > @@ -1210,96 +1218,8 @@ static int ov5640_set_autogain(struct ov5640_dev *sensor, bool on) > > > > > > static int ov5640_set_stream_dvp(struct ov5640_dev *sensor, bool on) > > > { > > > - int ret; > > > - unsigned int flags = sensor->ep.bus.parallel.flags; > > > - u8 pclk_pol = 0; > > > - u8 hsync_pol = 0; > > > - u8 vsync_pol = 0; > > > - > > > - /* > > > - * Note about parallel port configuration. > > > - * > > > - * When configured in parallel mode, the OV5640 will > > > - * output 10 bits data on DVP data lines [9:0]. > > > - * If only 8 bits data are wanted, the 8 bits data lines > > > - * of the camera interface must be physically connected > > > - * on the DVP data lines [9:2]. > > > - * > > > - * Control lines polarity can be configured through > > > - * devicetree endpoint control lines properties. > > > - * If no endpoint control lines properties are set, > > > - * polarity will be as below: > > > - * - VSYNC: active high > > > - * - HREF: active low > > > - * - PCLK: active low > > > - */ > > > - > > > - if (on) { > > > - /* > > > - * configure parallel port control lines polarity > > > - * > > > - * POLARITY CTRL0 > > > - * - [5]: PCLK polarity (0: active low, 1: active high) > > > - * - [1]: HREF polarity (0: active low, 1: active high) > > > - * - [0]: VSYNC polarity (mismatch here between > > > - * datasheet and hardware, 0 is active high > > > - * and 1 is active low...) > > > - */ > > > - if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > > - pclk_pol = 1; > > > - if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > > - hsync_pol = 1; > > > - if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > > - vsync_pol = 1; > > > - > > > - ret = ov5640_write_reg(sensor, > > > - OV5640_REG_POLARITY_CTRL00, > > > - (pclk_pol << 5) | > > > - (hsync_pol << 1) | > > > - vsync_pol); > > > - > > > - if (ret) > > > - return ret; > > > - } > > > - > > > - /* > > > - * powerdown MIPI TX/RX PHY & disable MIPI > > > - * > > > - * MIPI CONTROL 00 > > > - * 4: PWDN PHY TX > > > - * 3: PWDN PHY RX > > > - * 2: MIPI enable > > > - */ > > > - ret = ov5640_write_reg(sensor, > > > - OV5640_REG_IO_MIPI_CTRL00, on ? 0x18 : 0); > > > - if (ret) > > > - return ret; > > > - > > > - /* > > > - * enable VSYNC/HREF/PCLK DVP control lines > > > - * & D[9:6] DVP data lines > > > - * > > > - * PAD OUTPUT ENABLE 01 > > > - * - 6: VSYNC output enable > > > - * - 5: HREF output enable > > > - * - 4: PCLK output enable > > > - * - [3:0]: D[9:6] output enable > > > - */ > > > - ret = ov5640_write_reg(sensor, > > > - OV5640_REG_PAD_OUTPUT_ENABLE01, > > > - on ? 0x7f : 0); > > > - if (ret) > > > - return ret; > > > - > > > - /* > > > - * enable D[5:0] DVP data lines > > > - * > > > - * PAD OUTPUT ENABLE 02 > > > - * - [7:2]: D[5:0] output enable > > > - */ > > > - return ov5640_write_reg(sensor, > > > - OV5640_REG_PAD_OUTPUT_ENABLE02, > > > - on ? 0xfc : 0); > > > + return ov5640_write_reg(sensor, OV5640_REG_SYS_CTRL0, on ? > > > + OV5640_SOFTWARE_WAKEUP : OV5640_SOFTWARE_PWDN); I'm surprised entering/exiting from what is called "Software power down" in the chip manual retains the registers state! > > > } > > > > > > static int ov5640_set_stream_mipi(struct ov5640_dev *sensor, bool on) > > > @@ -2001,6 +1921,159 @@ static void ov5640_set_power_off(struct ov5640_dev *sensor) > > > clk_disable_unprepare(sensor->xclk); > > > } > > > > > > +static int ov5640_set_mipi(struct ov5640_dev *sensor, bool on) Maybe 'ov5640_set_power_mipi()' ? (same for dvp) > > > +{ > > > + int ret = 0; > > > + > > > + if (!on) { > > > + /* Reset MIPI bus settings to their default values. */ > > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > + ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x04); > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x00); > > > + > > > + return ret; > > > + } I know this was there already, but I wonder if this is now necessary (same for the DVP counterpart). We call this from the power up/down routine, if we get here with on=1 we are exiting from the chip powerdown mode and I expect registers to be restored to their default values. > > > + > > > + /* > > > + * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > > + * > > > + * 0x300e = 0x40 > > > + * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > > + * "ov5640_set_stream_mipi()") > > > + * [4] = 0 : Power up MIPI HS Tx > > > + * [3] = 0 : Power up MIPI LS Rx > > > + * [2] = 0 : MIPI interface disabled > > > + */ > > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x40); > > > + if (ret) > > > + return ret; > > > + > > > + /* > > > + * Gate clock and set LP11 in 'no packets mode' (idle) > > > + * > > > + * 0x4800 = 0x24 > > > + * [5] = 1 : Gate clock when 'no packets' > > > + * [2] = 1 : MIPI bus in LP11 when 'no packets' > > > + */ > > > + ret = ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x24); > > > + if (ret) > > > + return ret; > > > + > > > + /* > > > + * Set data lanes and clock in LP11 when 'sleeping' > > > + * > > > + * 0x3019 = 0x70 > > > + * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > > + * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > > + * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > > + */ > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x70); > > > + if (ret) > > > + return ret; > > > + > > > + /* Give lanes some time to coax into LP11 state. */ > > > + usleep_range(500, 1000); > > > + > > > + return 0; > > > +} > > > + > > > +static int ov5640_set_dvp(struct ov5640_dev *sensor, bool on) > > > +{ > > > + unsigned int flags = sensor->ep.bus.parallel.flags; > > > + u8 pclk_pol = 0; > > > + u8 hsync_pol = 0; > > > + u8 vsync_pol = 0; > > > + int ret = 0; > > > + > > > + if (!on) { > > > + /* Reset settings to their default values. */ > > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > + ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, 0x20); > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x00); > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0x00); > > > + > > > + return ret; > > > + } > > > + > > > + /* > > > + * Note about parallel port configuration. > > > + * > > > + * When configured in parallel mode, the OV5640 will > > > + * output 10 bits data on DVP data lines [9:0]. > > > + * If only 8 bits data are wanted, the 8 bits data lines > > > + * of the camera interface must be physically connected > > > + * on the DVP data lines [9:2]. > > > + * > > > + * Control lines polarity can be configured through > > > + * devicetree endpoint control lines properties. > > > + * If no endpoint control lines properties are set, > > > + * polarity will be as below: > > > + * - VSYNC: active high > > > + * - HREF: active low > > > + * - PCLK: active low > > > + */ > > > + /* > > > + * configure parallel port control lines polarity > > > + * > > > + * POLARITY CTRL0 > > > + * - [5]: PCLK polarity (0: active low, 1: active high) > > > + * - [1]: HREF polarity (0: active low, 1: active high) > > > + * - [0]: VSYNC polarity (mismatch here between > > > + * datasheet and hardware, 0 is active high > > > + * and 1 is active low...) > > > + */ > > > + if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > > + pclk_pol = 1; > > > + if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > > + hsync_pol = 1; > > > + if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > > + vsync_pol = 1; > > > + > > > + ret = ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, > > > + (pclk_pol << 5) | (hsync_pol << 1) | vsync_pol); > > > + > > > + if (ret) > > > + return ret; > > > + > > > + /* > > > + * powerdown MIPI TX/RX PHY & disable MIPI > > > + * > > > + * MIPI CONTROL 00 > > > + * 4: PWDN PHY TX > > > + * 3: PWDN PHY RX > > > + * 2: MIPI enable > > > + */ > > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x18); > > > + if (ret) > > > + return ret; > > > + > > > + /* > > > + * enable VSYNC/HREF/PCLK DVP control lines > > > + * & D[9:6] DVP data lines > > > + * > > > + * PAD OUTPUT ENABLE 01 > > > + * - 6: VSYNC output enable > > > + * - 5: HREF output enable > > > + * - 4: PCLK output enable > > > + * - [3:0]: D[9:6] output enable > > > + */ > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x7f); > > > + if (ret) > > > + return ret; > > > + > > > + /* > > > + * enable D[5:0] DVP data lines > > > + * > > > + * PAD OUTPUT ENABLE 02 > > > + * - [7:2]: D[5:0] output enable > > > + */ > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0xfc); > > > + if (ret) > > > + return ret; > > > + > > > + return 0; > > > +} > > > + > > > static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > > { > > > int ret = 0; > > > @@ -2013,67 +2086,17 @@ static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > > ret = ov5640_restore_mode(sensor); > > > if (ret) > > > goto power_off; > > > + } > > > > > > - /* We're done here for DVP bus, while CSI-2 needs setup. */ > > > - if (sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > > - return 0; > > > - > > > - /* > > > - * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > > - * > > > - * 0x300e = 0x40 > > > - * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > > - * "ov5640_set_stream_mipi()") > > > - * [4] = 0 : Power up MIPI HS Tx > > > - * [3] = 0 : Power up MIPI LS Rx > > > - * [2] = 0 : MIPI interface disabled > > > - */ > > > - ret = ov5640_write_reg(sensor, > > > - OV5640_REG_IO_MIPI_CTRL00, 0x40); > > > - if (ret) > > > - goto power_off; > > > - > > > - /* > > > - * Gate clock and set LP11 in 'no packets mode' (idle) > > > - * > > > - * 0x4800 = 0x24 > > > - * [5] = 1 : Gate clock when 'no packets' > > > - * [2] = 1 : MIPI bus in LP11 when 'no packets' > > > - */ > > > - ret = ov5640_write_reg(sensor, > > > - OV5640_REG_MIPI_CTRL00, 0x24); > > > - if (ret) > > > - goto power_off; > > > - > > > - /* > > > - * Set data lanes and clock in LP11 when 'sleeping' > > > - * > > > - * 0x3019 = 0x70 > > > - * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > > - * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > > - * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > > - */ > > > - ret = ov5640_write_reg(sensor, > > > - OV5640_REG_PAD_OUTPUT00, 0x70); > > > - if (ret) > > > - goto power_off; > > > - > > > - /* Give lanes some time to coax into LP11 state. */ > > > - usleep_range(500, 1000); > > > - > > > - } else { > > > - if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) { > > > - /* Reset MIPI bus settings to their default values. */ > > > - ov5640_write_reg(sensor, > > > - OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > - ov5640_write_reg(sensor, > > > - OV5640_REG_MIPI_CTRL00, 0x04); > > > - ov5640_write_reg(sensor, > > > - OV5640_REG_PAD_OUTPUT00, 0x00); > > > - } > > > + if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) > > > + ret = ov5640_set_mipi(sensor, on); > > > + else > > > + ret = ov5640_set_dvp(sensor, on); > > > + if (ret) > > > + goto power_off; If you agree the if (!on) case in the two set_mipi()/set_dvp() functions above can be removed, this function should become if (!on) { ov5640_set_power_off(sensor) return 0; } .... Thanks j > > > > > > + if (!on) > > > ov5640_set_power_off(sensor); > > > - } > > > > > > return 0; > > > > > > -- > > > 2.17.1 > > >
Hi Jacopo, Thank you for the review. On Fri, Aug 7, 2020 at 9:42 AM Jacopo Mondi <jacopo@jmondi.org> wrote: > > Hi Prabhakar, > + Paul who is working with this chip on a parallel setup > > On Thu, Aug 06, 2020 at 05:38:57PM +0100, Lad, Prabhakar wrote: > > Hi Jacopo, > > > > Thank you for the review. > > > > On Thu, Aug 6, 2020 at 5:27 PM Jacopo Mondi <jacopo@jmondi.org> wrote: > > > > > > Hi Prabhakar, > > > > > > On Mon, Aug 03, 2020 at 03:31:45PM +0100, Lad Prabhakar wrote: > > > > During testing this sensor on iW-RainboW-G21D-Qseven platform in 8-bit DVP > > > > mode with rcar-vin bridge noticed the capture worked fine for the first run > > > > (with yavta), but for subsequent runs the bridge driver waited for the > > > > frame to be captured. Debugging further noticed the data lines were > > > > enabled/disabled in stream on/off callback and dumping the register > > > > contents 0x3017/0x3018 in ov5640_set_stream_dvp() reported the correct > > > > values, but yet frame capturing failed. > > > > > > That's pretty weird, I wonder if that's not an issue in the bridge, as > > > I expect someone tryed to capture more than 1 image in DVP mode with > > > this driver already. > > > > > I did try the bridge driver with an ov7725 sensor and it works fine in > > both the modes (DVP and BT656). > > > > > I didn't get from your commit message if you have been able to > > > identify where the issue is. You said register values are correct, but > > > did you try to plug a scope and see if data are actually put on the > > > bus ? Does this happen with full parallel too or BT.656 only ? > > > > > unfortunately I didn't scope the pins, but this issue happened in both > > the modes. And with this patch it improves handling the sensor in > > s_stream call. > > > > For the record, I tested this one with my CSI-2 setup and capture > still works as expected. > Thank you for testing this. > > Cheers, > > Prabhakar > > > > > > > > > > To get around this issue the following actions are performed for > > > > parallel mode (DVP): > > > > 1: Keeps the sensor in software power down mode and is woken up only in > > > > ov5640_set_stream_dvp() callback. > > > > 2: Enables data lines in s_power callback > > > > 3: Configures HVP lines in s_power callback instead of configuring > > > > everytime in ov5640_set_stream_dvp(). > > > > 4: Disables MIPI interface. > > > > > > > > Fixes: f22996db44e2d ("media: ov5640: add support of DVP parallel interface") > > > > Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com> > > > > Reviewed-by: Biju Das <biju.das.jz@bp.renesas.com> > > > > --- > > > > drivers/media/i2c/ov5640.c | 321 ++++++++++++++++++++----------------- > > > > 1 file changed, 172 insertions(+), 149 deletions(-) > > > > > > > > diff --git a/drivers/media/i2c/ov5640.c b/drivers/media/i2c/ov5640.c > > > > index 2fe4a7ac0592..ec444bee2ce9 100644 > > > > --- a/drivers/media/i2c/ov5640.c > > > > +++ b/drivers/media/i2c/ov5640.c > > > > @@ -94,6 +94,9 @@ > > > > #define OV5640_REG_SDE_CTRL5 0x5585 > > > > #define OV5640_REG_AVG_READOUT 0x56a1 > > > > > > > > +#define OV5640_SOFTWARE_PWDN 0x42 > > > > +#define OV5640_SOFTWARE_WAKEUP 0x02 > > These two are bitmasks to apply to register 0x3008. I would place them > below the register definition and name them: > > #define OV5640_REG_SYS_CTRL0_SW_PWDN 0x42 > #define OV5640_REG_SYS_CTRL0_SW_PWUP 0x02 > > or even: > #define OV5640_REG_SYS_CTRL0_SW_POWER(on) (0x2 | (on ? 0x40 : 0x00)) > > Up to you, but I would keep them close to the register definition. > Agreed shall pick up the second option. > > > > + > > > > enum ov5640_mode_id { > > > > OV5640_MODE_QCIF_176_144 = 0, > > > > OV5640_MODE_QVGA_320_240, > > > > @@ -274,7 +277,7 @@ static inline struct v4l2_subdev *ctrl_to_sd(struct v4l2_ctrl *ctrl) > > > > /* YUV422 UYVY VGA@30fps */ > > > > static const struct reg_value ov5640_init_setting_30fps_VGA[] = { > > > > {0x3103, 0x11, 0, 0}, {0x3008, 0x82, 0, 5}, {0x3008, 0x42, 0, 0}, > > > > - {0x3103, 0x03, 0, 0}, {0x3017, 0x00, 0, 0}, {0x3018, 0x00, 0, 0}, > > > > + {0x3103, 0x03, 0, 0}, > > > > {0x3630, 0x36, 0, 0}, > > Could you reflow this lines to not leave holes ? > Will do. > > > > {0x3631, 0x0e, 0, 0}, {0x3632, 0xe2, 0, 0}, {0x3633, 0x12, 0, 0}, > > > > {0x3621, 0xe0, 0, 0}, {0x3704, 0xa0, 0, 0}, {0x3703, 0x5a, 0, 0}, > > > > @@ -1120,6 +1123,11 @@ static int ov5640_load_regs(struct ov5640_dev *sensor, > > > > val = regs->val; > > > > mask = regs->mask; > > > > > > > > + /* remain in power down mode for DVP */ > > > > + if (regs->reg_addr == OV5640_REG_SYS_CTRL0 && val == OV5640_SOFTWARE_WAKEUP && > > > > + sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > > > + continue; > > > > + > > I'm not yet convinced this is a good idea. This will cause the > ov5640_set_dvp() function to be called while the chip is still in > 'software power-down' mode. I tried to do the same for CSI-2 as well > and indeed I have LP-11 errors from the CSI-2 receiver, but then > capture works fine (puzzling! it might indicate that register values > as actually retained between software power up/down) > > This driver is such a mess I won't mind this 'special' dvp handling, > but it really puzzles me. > > From what I see here the bulk of this patch is about moving the > parallel bus configuration from s_stream() to s_power(), is this bit > here really required for that to work or is it a leftover ? Have you > tested it without the above hunk ? > Yes I have and it does work. but the idea behind this is to keep the sensor in powerdon mode all the time when nor streaming for DVP mode. > Paul, would you be able to test this series with your parallel setup > as well ? > > Also, if not strictly necessary, let's try to remain in the 80 cols limit. > OK. > > > > > if (mask) > > > > ret = ov5640_mod_reg(sensor, reg_addr, mask, val); > > > > else > > > > @@ -1210,96 +1218,8 @@ static int ov5640_set_autogain(struct ov5640_dev *sensor, bool on) > > > > > > > > static int ov5640_set_stream_dvp(struct ov5640_dev *sensor, bool on) > > > > { > > > > - int ret; > > > > - unsigned int flags = sensor->ep.bus.parallel.flags; > > > > - u8 pclk_pol = 0; > > > > - u8 hsync_pol = 0; > > > > - u8 vsync_pol = 0; > > > > - > > > > - /* > > > > - * Note about parallel port configuration. > > > > - * > > > > - * When configured in parallel mode, the OV5640 will > > > > - * output 10 bits data on DVP data lines [9:0]. > > > > - * If only 8 bits data are wanted, the 8 bits data lines > > > > - * of the camera interface must be physically connected > > > > - * on the DVP data lines [9:2]. > > > > - * > > > > - * Control lines polarity can be configured through > > > > - * devicetree endpoint control lines properties. > > > > - * If no endpoint control lines properties are set, > > > > - * polarity will be as below: > > > > - * - VSYNC: active high > > > > - * - HREF: active low > > > > - * - PCLK: active low > > > > - */ > > > > - > > > > - if (on) { > > > > - /* > > > > - * configure parallel port control lines polarity > > > > - * > > > > - * POLARITY CTRL0 > > > > - * - [5]: PCLK polarity (0: active low, 1: active high) > > > > - * - [1]: HREF polarity (0: active low, 1: active high) > > > > - * - [0]: VSYNC polarity (mismatch here between > > > > - * datasheet and hardware, 0 is active high > > > > - * and 1 is active low...) > > > > - */ > > > > - if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > > > - pclk_pol = 1; > > > > - if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > > > - hsync_pol = 1; > > > > - if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > > > - vsync_pol = 1; > > > > - > > > > - ret = ov5640_write_reg(sensor, > > > > - OV5640_REG_POLARITY_CTRL00, > > > > - (pclk_pol << 5) | > > > > - (hsync_pol << 1) | > > > > - vsync_pol); > > > > - > > > > - if (ret) > > > > - return ret; > > > > - } > > > > - > > > > - /* > > > > - * powerdown MIPI TX/RX PHY & disable MIPI > > > > - * > > > > - * MIPI CONTROL 00 > > > > - * 4: PWDN PHY TX > > > > - * 3: PWDN PHY RX > > > > - * 2: MIPI enable > > > > - */ > > > > - ret = ov5640_write_reg(sensor, > > > > - OV5640_REG_IO_MIPI_CTRL00, on ? 0x18 : 0); > > > > - if (ret) > > > > - return ret; > > > > - > > > > - /* > > > > - * enable VSYNC/HREF/PCLK DVP control lines > > > > - * & D[9:6] DVP data lines > > > > - * > > > > - * PAD OUTPUT ENABLE 01 > > > > - * - 6: VSYNC output enable > > > > - * - 5: HREF output enable > > > > - * - 4: PCLK output enable > > > > - * - [3:0]: D[9:6] output enable > > > > - */ > > > > - ret = ov5640_write_reg(sensor, > > > > - OV5640_REG_PAD_OUTPUT_ENABLE01, > > > > - on ? 0x7f : 0); > > > > - if (ret) > > > > - return ret; > > > > - > > > > - /* > > > > - * enable D[5:0] DVP data lines > > > > - * > > > > - * PAD OUTPUT ENABLE 02 > > > > - * - [7:2]: D[5:0] output enable > > > > - */ > > > > - return ov5640_write_reg(sensor, > > > > - OV5640_REG_PAD_OUTPUT_ENABLE02, > > > > - on ? 0xfc : 0); > > > > + return ov5640_write_reg(sensor, OV5640_REG_SYS_CTRL0, on ? > > > > + OV5640_SOFTWARE_WAKEUP : OV5640_SOFTWARE_PWDN); > > I'm surprised entering/exiting from what is called "Software power > down" in the chip manual retains the registers state! > In fact as part of the initial register sequence the sensor is put into power down mode, the required registers are set and then the sensor is woken up. > > > > } > > > > > > > > static int ov5640_set_stream_mipi(struct ov5640_dev *sensor, bool on) > > > > @@ -2001,6 +1921,159 @@ static void ov5640_set_power_off(struct ov5640_dev *sensor) > > > > clk_disable_unprepare(sensor->xclk); > > > > } > > > > > > > > +static int ov5640_set_mipi(struct ov5640_dev *sensor, bool on) > > Maybe 'ov5640_set_power_mipi()' ? (same for dvp) > OK will replace it. > > > > +{ > > > > + int ret = 0; > > > > + > > > > + if (!on) { > > > > + /* Reset MIPI bus settings to their default values. */ > > > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > > + ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x04); > > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x00); > > > > + > > > > + return ret; > > > > + } > > I know this was there already, but I wonder if this is now necessary > (same for the DVP counterpart). > > We call this from the power up/down routine, if we get here with on=1 > we are exiting from the chip powerdown mode and I expect registers to > be restored to their default values. > No waking up the sensor from power down mode doesnt restore the register to default values, infact it will retain the values which are already set to. Fyi I picked up the datasheet from [1] [1] http://e2e.ti.com/cfs-file.ashx/__key/communityserver-discussions-components-files/100/2604.OV7725_5F00_CSP2_5F00_DS-_2800_1_5B00_1_5D00_.31_2900_.pdf > > > > + > > > > + /* > > > > + * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > > > + * > > > > + * 0x300e = 0x40 > > > > + * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > > > + * "ov5640_set_stream_mipi()") > > > > + * [4] = 0 : Power up MIPI HS Tx > > > > + * [3] = 0 : Power up MIPI LS Rx > > > > + * [2] = 0 : MIPI interface disabled > > > > + */ > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x40); > > > > + if (ret) > > > > + return ret; > > > > + > > > > + /* > > > > + * Gate clock and set LP11 in 'no packets mode' (idle) > > > > + * > > > > + * 0x4800 = 0x24 > > > > + * [5] = 1 : Gate clock when 'no packets' > > > > + * [2] = 1 : MIPI bus in LP11 when 'no packets' > > > > + */ > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x24); > > > > + if (ret) > > > > + return ret; > > > > + > > > > + /* > > > > + * Set data lanes and clock in LP11 when 'sleeping' > > > > + * > > > > + * 0x3019 = 0x70 > > > > + * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > > > + * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > > > + * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > > > + */ > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x70); > > > > + if (ret) > > > > + return ret; > > > > + > > > > + /* Give lanes some time to coax into LP11 state. */ > > > > + usleep_range(500, 1000); > > > > + > > > > + return 0; > > > > +} > > > > + > > > > +static int ov5640_set_dvp(struct ov5640_dev *sensor, bool on) > > > > +{ > > > > + unsigned int flags = sensor->ep.bus.parallel.flags; > > > > + u8 pclk_pol = 0; > > > > + u8 hsync_pol = 0; > > > > + u8 vsync_pol = 0; > > > > + int ret = 0; > > > > + > > > > + if (!on) { > > > > + /* Reset settings to their default values. */ > > > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > > + ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, 0x20); > > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x00); > > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0x00); > > > > + > > > > + return ret; > > > > + } > > > > + > > > > + /* > > > > + * Note about parallel port configuration. > > > > + * > > > > + * When configured in parallel mode, the OV5640 will > > > > + * output 10 bits data on DVP data lines [9:0]. > > > > + * If only 8 bits data are wanted, the 8 bits data lines > > > > + * of the camera interface must be physically connected > > > > + * on the DVP data lines [9:2]. > > > > + * > > > > + * Control lines polarity can be configured through > > > > + * devicetree endpoint control lines properties. > > > > + * If no endpoint control lines properties are set, > > > > + * polarity will be as below: > > > > + * - VSYNC: active high > > > > + * - HREF: active low > > > > + * - PCLK: active low > > > > + */ > > > > + /* > > > > + * configure parallel port control lines polarity > > > > + * > > > > + * POLARITY CTRL0 > > > > + * - [5]: PCLK polarity (0: active low, 1: active high) > > > > + * - [1]: HREF polarity (0: active low, 1: active high) > > > > + * - [0]: VSYNC polarity (mismatch here between > > > > + * datasheet and hardware, 0 is active high > > > > + * and 1 is active low...) > > > > + */ > > > > + if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > > > + pclk_pol = 1; > > > > + if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > > > + hsync_pol = 1; > > > > + if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > > > + vsync_pol = 1; > > > > + > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, > > > > + (pclk_pol << 5) | (hsync_pol << 1) | vsync_pol); > > > > + > > > > + if (ret) > > > > + return ret; > > > > + > > > > + /* > > > > + * powerdown MIPI TX/RX PHY & disable MIPI > > > > + * > > > > + * MIPI CONTROL 00 > > > > + * 4: PWDN PHY TX > > > > + * 3: PWDN PHY RX > > > > + * 2: MIPI enable > > > > + */ > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x18); > > > > + if (ret) > > > > + return ret; > > > > + > > > > + /* > > > > + * enable VSYNC/HREF/PCLK DVP control lines > > > > + * & D[9:6] DVP data lines > > > > + * > > > > + * PAD OUTPUT ENABLE 01 > > > > + * - 6: VSYNC output enable > > > > + * - 5: HREF output enable > > > > + * - 4: PCLK output enable > > > > + * - [3:0]: D[9:6] output enable > > > > + */ > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x7f); > > > > + if (ret) > > > > + return ret; > > > > + > > > > + /* > > > > + * enable D[5:0] DVP data lines > > > > + * > > > > + * PAD OUTPUT ENABLE 02 > > > > + * - [7:2]: D[5:0] output enable > > > > + */ > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0xfc); > > > > + if (ret) > > > > + return ret; > > > > + > > > > + return 0; > > > > +} > > > > + > > > > static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > > > { > > > > int ret = 0; > > > > @@ -2013,67 +2086,17 @@ static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > > > ret = ov5640_restore_mode(sensor); > > > > if (ret) > > > > goto power_off; > > > > + } > > > > > > > > - /* We're done here for DVP bus, while CSI-2 needs setup. */ > > > > - if (sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > > > - return 0; > > > > - > > > > - /* > > > > - * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > > > - * > > > > - * 0x300e = 0x40 > > > > - * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > > > - * "ov5640_set_stream_mipi()") > > > > - * [4] = 0 : Power up MIPI HS Tx > > > > - * [3] = 0 : Power up MIPI LS Rx > > > > - * [2] = 0 : MIPI interface disabled > > > > - */ > > > > - ret = ov5640_write_reg(sensor, > > > > - OV5640_REG_IO_MIPI_CTRL00, 0x40); > > > > - if (ret) > > > > - goto power_off; > > > > - > > > > - /* > > > > - * Gate clock and set LP11 in 'no packets mode' (idle) > > > > - * > > > > - * 0x4800 = 0x24 > > > > - * [5] = 1 : Gate clock when 'no packets' > > > > - * [2] = 1 : MIPI bus in LP11 when 'no packets' > > > > - */ > > > > - ret = ov5640_write_reg(sensor, > > > > - OV5640_REG_MIPI_CTRL00, 0x24); > > > > - if (ret) > > > > - goto power_off; > > > > - > > > > - /* > > > > - * Set data lanes and clock in LP11 when 'sleeping' > > > > - * > > > > - * 0x3019 = 0x70 > > > > - * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > > > - * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > > > - * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > > > - */ > > > > - ret = ov5640_write_reg(sensor, > > > > - OV5640_REG_PAD_OUTPUT00, 0x70); > > > > - if (ret) > > > > - goto power_off; > > > > - > > > > - /* Give lanes some time to coax into LP11 state. */ > > > > - usleep_range(500, 1000); > > > > - > > > > - } else { > > > > - if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) { > > > > - /* Reset MIPI bus settings to their default values. */ > > > > - ov5640_write_reg(sensor, > > > > - OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > > - ov5640_write_reg(sensor, > > > > - OV5640_REG_MIPI_CTRL00, 0x04); > > > > - ov5640_write_reg(sensor, > > > > - OV5640_REG_PAD_OUTPUT00, 0x00); > > > > - } > > > > + if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) > > > > + ret = ov5640_set_mipi(sensor, on); > > > > + else > > > > + ret = ov5640_set_dvp(sensor, on); > > > > + if (ret) > > > > + goto power_off; > > If you agree the if (!on) case in the two set_mipi()/set_dvp() functions > above can be removed, this function should become > I would keep it, as mentioned above. Cheers, Prabhakar
Hi Prabhakar, On Mon, Aug 10, 2020 at 08:40:29AM +0100, Lad, Prabhakar wrote: > Hi Jacopo, > > Thank you for the review. > > On Fri, Aug 7, 2020 at 9:42 AM Jacopo Mondi <jacopo@jmondi.org> wrote: > > > > Hi Prabhakar, > > + Paul who is working with this chip on a parallel setup > > > > On Thu, Aug 06, 2020 at 05:38:57PM +0100, Lad, Prabhakar wrote: > > > Hi Jacopo, > > > > > > Thank you for the review. > > > > > > On Thu, Aug 6, 2020 at 5:27 PM Jacopo Mondi <jacopo@jmondi.org> wrote: > > > > > > > > Hi Prabhakar, > > > > > > > > On Mon, Aug 03, 2020 at 03:31:45PM +0100, Lad Prabhakar wrote: > > > > > During testing this sensor on iW-RainboW-G21D-Qseven platform in 8-bit DVP > > > > > mode with rcar-vin bridge noticed the capture worked fine for the first run > > > > > (with yavta), but for subsequent runs the bridge driver waited for the > > > > > frame to be captured. Debugging further noticed the data lines were > > > > > enabled/disabled in stream on/off callback and dumping the register > > > > > contents 0x3017/0x3018 in ov5640_set_stream_dvp() reported the correct > > > > > values, but yet frame capturing failed. > > > > > > > > That's pretty weird, I wonder if that's not an issue in the bridge, as > > > > I expect someone tryed to capture more than 1 image in DVP mode with > > > > this driver already. > > > > > > > I did try the bridge driver with an ov7725 sensor and it works fine in > > > both the modes (DVP and BT656). > > > > > > > I didn't get from your commit message if you have been able to > > > > identify where the issue is. You said register values are correct, but > > > > did you try to plug a scope and see if data are actually put on the > > > > bus ? Does this happen with full parallel too or BT.656 only ? > > > > > > > unfortunately I didn't scope the pins, but this issue happened in both > > > the modes. And with this patch it improves handling the sensor in > > > s_stream call. > > > > > > > For the record, I tested this one with my CSI-2 setup and capture > > still works as expected. > > > Thank you for testing this. > > > > Cheers, > > > Prabhakar > > > > > > > > > > > > > To get around this issue the following actions are performed for > > > > > parallel mode (DVP): > > > > > 1: Keeps the sensor in software power down mode and is woken up only in > > > > > ov5640_set_stream_dvp() callback. > > > > > 2: Enables data lines in s_power callback > > > > > 3: Configures HVP lines in s_power callback instead of configuring > > > > > everytime in ov5640_set_stream_dvp(). > > > > > 4: Disables MIPI interface. > > > > > > > > > > Fixes: f22996db44e2d ("media: ov5640: add support of DVP parallel interface") > > > > > Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com> > > > > > Reviewed-by: Biju Das <biju.das.jz@bp.renesas.com> > > > > > --- > > > > > drivers/media/i2c/ov5640.c | 321 ++++++++++++++++++++----------------- > > > > > 1 file changed, 172 insertions(+), 149 deletions(-) > > > > > > > > > > diff --git a/drivers/media/i2c/ov5640.c b/drivers/media/i2c/ov5640.c > > > > > index 2fe4a7ac0592..ec444bee2ce9 100644 > > > > > --- a/drivers/media/i2c/ov5640.c > > > > > +++ b/drivers/media/i2c/ov5640.c > > > > > @@ -94,6 +94,9 @@ > > > > > #define OV5640_REG_SDE_CTRL5 0x5585 > > > > > #define OV5640_REG_AVG_READOUT 0x56a1 > > > > > > > > > > +#define OV5640_SOFTWARE_PWDN 0x42 > > > > > +#define OV5640_SOFTWARE_WAKEUP 0x02 > > > > These two are bitmasks to apply to register 0x3008. I would place them > > below the register definition and name them: > > > > #define OV5640_REG_SYS_CTRL0_SW_PWDN 0x42 > > #define OV5640_REG_SYS_CTRL0_SW_PWUP 0x02 > > > > or even: > > #define OV5640_REG_SYS_CTRL0_SW_POWER(on) (0x2 | (on ? 0x40 : 0x00)) > > > > Up to you, but I would keep them close to the register definition. > > > Agreed shall pick up the second option. > Thanks > > > > > + > > > > > enum ov5640_mode_id { > > > > > OV5640_MODE_QCIF_176_144 = 0, > > > > > OV5640_MODE_QVGA_320_240, > > > > > @@ -274,7 +277,7 @@ static inline struct v4l2_subdev *ctrl_to_sd(struct v4l2_ctrl *ctrl) > > > > > /* YUV422 UYVY VGA@30fps */ > > > > > static const struct reg_value ov5640_init_setting_30fps_VGA[] = { > > > > > {0x3103, 0x11, 0, 0}, {0x3008, 0x82, 0, 5}, {0x3008, 0x42, 0, 0}, > > > > > - {0x3103, 0x03, 0, 0}, {0x3017, 0x00, 0, 0}, {0x3018, 0x00, 0, 0}, > > > > > + {0x3103, 0x03, 0, 0}, > > > > > {0x3630, 0x36, 0, 0}, > > > > Could you reflow this lines to not leave holes ? > > > Will do. > Thank you > > > > > {0x3631, 0x0e, 0, 0}, {0x3632, 0xe2, 0, 0}, {0x3633, 0x12, 0, 0}, > > > > > {0x3621, 0xe0, 0, 0}, {0x3704, 0xa0, 0, 0}, {0x3703, 0x5a, 0, 0}, > > > > > @@ -1120,6 +1123,11 @@ static int ov5640_load_regs(struct ov5640_dev *sensor, > > > > > val = regs->val; > > > > > mask = regs->mask; > > > > > > > > > > + /* remain in power down mode for DVP */ > > > > > + if (regs->reg_addr == OV5640_REG_SYS_CTRL0 && val == OV5640_SOFTWARE_WAKEUP && > > > > > + sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > > > > + continue; > > > > > + > > > > I'm not yet convinced this is a good idea. This will cause the > > ov5640_set_dvp() function to be called while the chip is still in > > 'software power-down' mode. I tried to do the same for CSI-2 as well > > and indeed I have LP-11 errors from the CSI-2 receiver, but then > > capture works fine (puzzling! it might indicate that register values > > as actually retained between software power up/down) > > > > This driver is such a mess I won't mind this 'special' dvp handling, > > but it really puzzles me. > > > > From what I see here the bulk of this patch is about moving the > > parallel bus configuration from s_stream() to s_power(), is this bit > > here really required for that to work or is it a leftover ? Have you > > tested it without the above hunk ? > > > Yes I have and it does work. but the idea behind this is to keep the > sensor in powerdon mode all the time when nor streaming for DVP mode. > I see, thanks for testing > > Paul, would you be able to test this series with your parallel setup > > as well ? > > > > Also, if not strictly necessary, let's try to remain in the 80 cols limit. > > > OK. > > > > > > > > if (mask) > > > > > ret = ov5640_mod_reg(sensor, reg_addr, mask, val); > > > > > else > > > > > @@ -1210,96 +1218,8 @@ static int ov5640_set_autogain(struct ov5640_dev *sensor, bool on) > > > > > > > > > > static int ov5640_set_stream_dvp(struct ov5640_dev *sensor, bool on) > > > > > { > > > > > - int ret; > > > > > - unsigned int flags = sensor->ep.bus.parallel.flags; > > > > > - u8 pclk_pol = 0; > > > > > - u8 hsync_pol = 0; > > > > > - u8 vsync_pol = 0; > > > > > - > > > > > - /* > > > > > - * Note about parallel port configuration. > > > > > - * > > > > > - * When configured in parallel mode, the OV5640 will > > > > > - * output 10 bits data on DVP data lines [9:0]. > > > > > - * If only 8 bits data are wanted, the 8 bits data lines > > > > > - * of the camera interface must be physically connected > > > > > - * on the DVP data lines [9:2]. > > > > > - * > > > > > - * Control lines polarity can be configured through > > > > > - * devicetree endpoint control lines properties. > > > > > - * If no endpoint control lines properties are set, > > > > > - * polarity will be as below: > > > > > - * - VSYNC: active high > > > > > - * - HREF: active low > > > > > - * - PCLK: active low > > > > > - */ > > > > > - > > > > > - if (on) { > > > > > - /* > > > > > - * configure parallel port control lines polarity > > > > > - * > > > > > - * POLARITY CTRL0 > > > > > - * - [5]: PCLK polarity (0: active low, 1: active high) > > > > > - * - [1]: HREF polarity (0: active low, 1: active high) > > > > > - * - [0]: VSYNC polarity (mismatch here between > > > > > - * datasheet and hardware, 0 is active high > > > > > - * and 1 is active low...) > > > > > - */ > > > > > - if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > > > > - pclk_pol = 1; > > > > > - if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > > > > - hsync_pol = 1; > > > > > - if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > > > > - vsync_pol = 1; > > > > > - > > > > > - ret = ov5640_write_reg(sensor, > > > > > - OV5640_REG_POLARITY_CTRL00, > > > > > - (pclk_pol << 5) | > > > > > - (hsync_pol << 1) | > > > > > - vsync_pol); > > > > > - > > > > > - if (ret) > > > > > - return ret; > > > > > - } > > > > > - > > > > > - /* > > > > > - * powerdown MIPI TX/RX PHY & disable MIPI > > > > > - * > > > > > - * MIPI CONTROL 00 > > > > > - * 4: PWDN PHY TX > > > > > - * 3: PWDN PHY RX > > > > > - * 2: MIPI enable > > > > > - */ > > > > > - ret = ov5640_write_reg(sensor, > > > > > - OV5640_REG_IO_MIPI_CTRL00, on ? 0x18 : 0); > > > > > - if (ret) > > > > > - return ret; > > > > > - > > > > > - /* > > > > > - * enable VSYNC/HREF/PCLK DVP control lines > > > > > - * & D[9:6] DVP data lines > > > > > - * > > > > > - * PAD OUTPUT ENABLE 01 > > > > > - * - 6: VSYNC output enable > > > > > - * - 5: HREF output enable > > > > > - * - 4: PCLK output enable > > > > > - * - [3:0]: D[9:6] output enable > > > > > - */ > > > > > - ret = ov5640_write_reg(sensor, > > > > > - OV5640_REG_PAD_OUTPUT_ENABLE01, > > > > > - on ? 0x7f : 0); > > > > > - if (ret) > > > > > - return ret; > > > > > - > > > > > - /* > > > > > - * enable D[5:0] DVP data lines > > > > > - * > > > > > - * PAD OUTPUT ENABLE 02 > > > > > - * - [7:2]: D[5:0] output enable > > > > > - */ > > > > > - return ov5640_write_reg(sensor, > > > > > - OV5640_REG_PAD_OUTPUT_ENABLE02, > > > > > - on ? 0xfc : 0); > > > > > + return ov5640_write_reg(sensor, OV5640_REG_SYS_CTRL0, on ? > > > > > + OV5640_SOFTWARE_WAKEUP : OV5640_SOFTWARE_PWDN); > > > > I'm surprised entering/exiting from what is called "Software power > > down" in the chip manual retains the registers state! > > > In fact as part of the initial register sequence the sensor is put > into power down mode, the required registers are set and then the > sensor is woken up. > That's funny. So the 'software power down' mode retains the internal volatile memory content I assume. Nice to know and thanks for digging! > > > > > } > > > > > > > > > > static int ov5640_set_stream_mipi(struct ov5640_dev *sensor, bool on) > > > > > @@ -2001,6 +1921,159 @@ static void ov5640_set_power_off(struct ov5640_dev *sensor) > > > > > clk_disable_unprepare(sensor->xclk); > > > > > } > > > > > > > > > > +static int ov5640_set_mipi(struct ov5640_dev *sensor, bool on) > > > > Maybe 'ov5640_set_power_mipi()' ? (same for dvp) > > > OK will replace it. > Thanks > > > > > +{ > > > > > + int ret = 0; > > > > > + > > > > > + if (!on) { > > > > > + /* Reset MIPI bus settings to their default values. */ > > > > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > > > + ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x04); > > > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x00); > > > > > + > > > > > + return ret; > > > > > + } > > > > I know this was there already, but I wonder if this is now necessary > > (same for the DVP counterpart). > > > > We call this from the power up/down routine, if we get here with on=1 > > we are exiting from the chip powerdown mode and I expect registers to > > be restored to their default values. > > > No waking up the sensor from power down mode doesnt restore the > register to default values, infact it will retain the values which are > already set to. Fyi I picked up the datasheet from [1] > Careful here, I now understand 'software power down' might retain the configuration, but this is called by in the s_power() call chain, which powers the chip up/down by enabling and disabling clocks and regulator and resetting the chip (see ov5640_set_power_on() which is called before this function). I would really be surprised register values are retained after the regulators have been shut off :) > [1] http://e2e.ti.com/cfs-file.ashx/__key/communityserver-discussions-components-files/100/2604.OV7725_5F00_CSP2_5F00_DS-_2800_1_5B00_1_5D00_.31_2900_.pdf Nice, but that's for ov7725 :) Thanks j > > > > > > + > > > > > + /* > > > > > + * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > > > > + * > > > > > + * 0x300e = 0x40 > > > > > + * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > > > > + * "ov5640_set_stream_mipi()") > > > > > + * [4] = 0 : Power up MIPI HS Tx > > > > > + * [3] = 0 : Power up MIPI LS Rx > > > > > + * [2] = 0 : MIPI interface disabled > > > > > + */ > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x40); > > > > > + if (ret) > > > > > + return ret; > > > > > + > > > > > + /* > > > > > + * Gate clock and set LP11 in 'no packets mode' (idle) > > > > > + * > > > > > + * 0x4800 = 0x24 > > > > > + * [5] = 1 : Gate clock when 'no packets' > > > > > + * [2] = 1 : MIPI bus in LP11 when 'no packets' > > > > > + */ > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x24); > > > > > + if (ret) > > > > > + return ret; > > > > > + > > > > > + /* > > > > > + * Set data lanes and clock in LP11 when 'sleeping' > > > > > + * > > > > > + * 0x3019 = 0x70 > > > > > + * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > > > > + * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > > > > + * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > > > > + */ > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x70); > > > > > + if (ret) > > > > > + return ret; > > > > > + > > > > > + /* Give lanes some time to coax into LP11 state. */ > > > > > + usleep_range(500, 1000); > > > > > + > > > > > + return 0; > > > > > +} > > > > > + > > > > > +static int ov5640_set_dvp(struct ov5640_dev *sensor, bool on) > > > > > +{ > > > > > + unsigned int flags = sensor->ep.bus.parallel.flags; > > > > > + u8 pclk_pol = 0; > > > > > + u8 hsync_pol = 0; > > > > > + u8 vsync_pol = 0; > > > > > + int ret = 0; > > > > > + > > > > > + if (!on) { > > > > > + /* Reset settings to their default values. */ > > > > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > > > + ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, 0x20); > > > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x00); > > > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0x00); > > > > > + > > > > > + return ret; > > > > > + } > > > > > + > > > > > + /* > > > > > + * Note about parallel port configuration. > > > > > + * > > > > > + * When configured in parallel mode, the OV5640 will > > > > > + * output 10 bits data on DVP data lines [9:0]. > > > > > + * If only 8 bits data are wanted, the 8 bits data lines > > > > > + * of the camera interface must be physically connected > > > > > + * on the DVP data lines [9:2]. > > > > > + * > > > > > + * Control lines polarity can be configured through > > > > > + * devicetree endpoint control lines properties. > > > > > + * If no endpoint control lines properties are set, > > > > > + * polarity will be as below: > > > > > + * - VSYNC: active high > > > > > + * - HREF: active low > > > > > + * - PCLK: active low > > > > > + */ > > > > > + /* > > > > > + * configure parallel port control lines polarity > > > > > + * > > > > > + * POLARITY CTRL0 > > > > > + * - [5]: PCLK polarity (0: active low, 1: active high) > > > > > + * - [1]: HREF polarity (0: active low, 1: active high) > > > > > + * - [0]: VSYNC polarity (mismatch here between > > > > > + * datasheet and hardware, 0 is active high > > > > > + * and 1 is active low...) > > > > > + */ > > > > > + if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > > > > + pclk_pol = 1; > > > > > + if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > > > > + hsync_pol = 1; > > > > > + if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > > > > + vsync_pol = 1; > > > > > + > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, > > > > > + (pclk_pol << 5) | (hsync_pol << 1) | vsync_pol); > > > > > + > > > > > + if (ret) > > > > > + return ret; > > > > > + > > > > > + /* > > > > > + * powerdown MIPI TX/RX PHY & disable MIPI > > > > > + * > > > > > + * MIPI CONTROL 00 > > > > > + * 4: PWDN PHY TX > > > > > + * 3: PWDN PHY RX > > > > > + * 2: MIPI enable > > > > > + */ > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x18); > > > > > + if (ret) > > > > > + return ret; > > > > > + > > > > > + /* > > > > > + * enable VSYNC/HREF/PCLK DVP control lines > > > > > + * & D[9:6] DVP data lines > > > > > + * > > > > > + * PAD OUTPUT ENABLE 01 > > > > > + * - 6: VSYNC output enable > > > > > + * - 5: HREF output enable > > > > > + * - 4: PCLK output enable > > > > > + * - [3:0]: D[9:6] output enable > > > > > + */ > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x7f); > > > > > + if (ret) > > > > > + return ret; > > > > > + > > > > > + /* > > > > > + * enable D[5:0] DVP data lines > > > > > + * > > > > > + * PAD OUTPUT ENABLE 02 > > > > > + * - [7:2]: D[5:0] output enable > > > > > + */ > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0xfc); > > > > > + if (ret) > > > > > + return ret; > > > > > + > > > > > + return 0; > > > > > +} > > > > > + > > > > > static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > > > > { > > > > > int ret = 0; > > > > > @@ -2013,67 +2086,17 @@ static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > > > > ret = ov5640_restore_mode(sensor); > > > > > if (ret) > > > > > goto power_off; > > > > > + } > > > > > > > > > > - /* We're done here for DVP bus, while CSI-2 needs setup. */ > > > > > - if (sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > > > > - return 0; > > > > > - > > > > > - /* > > > > > - * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > > > > - * > > > > > - * 0x300e = 0x40 > > > > > - * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > > > > - * "ov5640_set_stream_mipi()") > > > > > - * [4] = 0 : Power up MIPI HS Tx > > > > > - * [3] = 0 : Power up MIPI LS Rx > > > > > - * [2] = 0 : MIPI interface disabled > > > > > - */ > > > > > - ret = ov5640_write_reg(sensor, > > > > > - OV5640_REG_IO_MIPI_CTRL00, 0x40); > > > > > - if (ret) > > > > > - goto power_off; > > > > > - > > > > > - /* > > > > > - * Gate clock and set LP11 in 'no packets mode' (idle) > > > > > - * > > > > > - * 0x4800 = 0x24 > > > > > - * [5] = 1 : Gate clock when 'no packets' > > > > > - * [2] = 1 : MIPI bus in LP11 when 'no packets' > > > > > - */ > > > > > - ret = ov5640_write_reg(sensor, > > > > > - OV5640_REG_MIPI_CTRL00, 0x24); > > > > > - if (ret) > > > > > - goto power_off; > > > > > - > > > > > - /* > > > > > - * Set data lanes and clock in LP11 when 'sleeping' > > > > > - * > > > > > - * 0x3019 = 0x70 > > > > > - * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > > > > - * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > > > > - * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > > > > - */ > > > > > - ret = ov5640_write_reg(sensor, > > > > > - OV5640_REG_PAD_OUTPUT00, 0x70); > > > > > - if (ret) > > > > > - goto power_off; > > > > > - > > > > > - /* Give lanes some time to coax into LP11 state. */ > > > > > - usleep_range(500, 1000); > > > > > - > > > > > - } else { > > > > > - if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) { > > > > > - /* Reset MIPI bus settings to their default values. */ > > > > > - ov5640_write_reg(sensor, > > > > > - OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > > > - ov5640_write_reg(sensor, > > > > > - OV5640_REG_MIPI_CTRL00, 0x04); > > > > > - ov5640_write_reg(sensor, > > > > > - OV5640_REG_PAD_OUTPUT00, 0x00); > > > > > - } > > > > > + if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) > > > > > + ret = ov5640_set_mipi(sensor, on); > > > > > + else > > > > > + ret = ov5640_set_dvp(sensor, on); > > > > > + if (ret) > > > > > + goto power_off; > > > > If you agree the if (!on) case in the two set_mipi()/set_dvp() functions > > above can be removed, this function should become > > > I would keep it, as mentioned above. > > Cheers, > Prabhakar
Hi Jacopo, On Mon, Aug 10, 2020 at 9:39 AM Jacopo Mondi <jacopo@jmondi.org> wrote: > > Hi Prabhakar, > > On Mon, Aug 10, 2020 at 08:40:29AM +0100, Lad, Prabhakar wrote: > > Hi Jacopo, > > > > Thank you for the review. > > > > On Fri, Aug 7, 2020 at 9:42 AM Jacopo Mondi <jacopo@jmondi.org> wrote: > > > > > > Hi Prabhakar, > > > + Paul who is working with this chip on a parallel setup > > > > > > On Thu, Aug 06, 2020 at 05:38:57PM +0100, Lad, Prabhakar wrote: > > > > Hi Jacopo, > > > > > > > > Thank you for the review. > > > > > > > > On Thu, Aug 6, 2020 at 5:27 PM Jacopo Mondi <jacopo@jmondi.org> wrote: > > > > > > > > > > Hi Prabhakar, > > > > > > > > > > On Mon, Aug 03, 2020 at 03:31:45PM +0100, Lad Prabhakar wrote: > > > > > > During testing this sensor on iW-RainboW-G21D-Qseven platform in 8-bit DVP > > > > > > mode with rcar-vin bridge noticed the capture worked fine for the first run > > > > > > (with yavta), but for subsequent runs the bridge driver waited for the > > > > > > frame to be captured. Debugging further noticed the data lines were > > > > > > enabled/disabled in stream on/off callback and dumping the register > > > > > > contents 0x3017/0x3018 in ov5640_set_stream_dvp() reported the correct > > > > > > values, but yet frame capturing failed. > > > > > > > > > > That's pretty weird, I wonder if that's not an issue in the bridge, as > > > > > I expect someone tryed to capture more than 1 image in DVP mode with > > > > > this driver already. > > > > > > > > > I did try the bridge driver with an ov7725 sensor and it works fine in > > > > both the modes (DVP and BT656). > > > > > > > > > I didn't get from your commit message if you have been able to > > > > > identify where the issue is. You said register values are correct, but > > > > > did you try to plug a scope and see if data are actually put on the > > > > > bus ? Does this happen with full parallel too or BT.656 only ? > > > > > > > > > unfortunately I didn't scope the pins, but this issue happened in both > > > > the modes. And with this patch it improves handling the sensor in > > > > s_stream call. > > > > > > > > > > For the record, I tested this one with my CSI-2 setup and capture > > > still works as expected. > > > > > Thank you for testing this. > > > > > > Cheers, > > > > Prabhakar > > > > > > > > > > > > > > > > To get around this issue the following actions are performed for > > > > > > parallel mode (DVP): > > > > > > 1: Keeps the sensor in software power down mode and is woken up only in > > > > > > ov5640_set_stream_dvp() callback. > > > > > > 2: Enables data lines in s_power callback > > > > > > 3: Configures HVP lines in s_power callback instead of configuring > > > > > > everytime in ov5640_set_stream_dvp(). > > > > > > 4: Disables MIPI interface. > > > > > > > > > > > > Fixes: f22996db44e2d ("media: ov5640: add support of DVP parallel interface") > > > > > > Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com> > > > > > > Reviewed-by: Biju Das <biju.das.jz@bp.renesas.com> > > > > > > --- > > > > > > drivers/media/i2c/ov5640.c | 321 ++++++++++++++++++++----------------- > > > > > > 1 file changed, 172 insertions(+), 149 deletions(-) > > > > > > > > > > > > diff --git a/drivers/media/i2c/ov5640.c b/drivers/media/i2c/ov5640.c > > > > > > index 2fe4a7ac0592..ec444bee2ce9 100644 > > > > > > --- a/drivers/media/i2c/ov5640.c > > > > > > +++ b/drivers/media/i2c/ov5640.c > > > > > > @@ -94,6 +94,9 @@ > > > > > > #define OV5640_REG_SDE_CTRL5 0x5585 > > > > > > #define OV5640_REG_AVG_READOUT 0x56a1 > > > > > > > > > > > > +#define OV5640_SOFTWARE_PWDN 0x42 > > > > > > +#define OV5640_SOFTWARE_WAKEUP 0x02 > > > > > > These two are bitmasks to apply to register 0x3008. I would place them > > > below the register definition and name them: > > > > > > #define OV5640_REG_SYS_CTRL0_SW_PWDN 0x42 > > > #define OV5640_REG_SYS_CTRL0_SW_PWUP 0x02 > > > > > > or even: > > > #define OV5640_REG_SYS_CTRL0_SW_POWER(on) (0x2 | (on ? 0x40 : 0x00)) > > > > > > Up to you, but I would keep them close to the register definition. > > > > > Agreed shall pick up the second option. > > > > Thanks > > > > > > > + > > > > > > enum ov5640_mode_id { > > > > > > OV5640_MODE_QCIF_176_144 = 0, > > > > > > OV5640_MODE_QVGA_320_240, > > > > > > @@ -274,7 +277,7 @@ static inline struct v4l2_subdev *ctrl_to_sd(struct v4l2_ctrl *ctrl) > > > > > > /* YUV422 UYVY VGA@30fps */ > > > > > > static const struct reg_value ov5640_init_setting_30fps_VGA[] = { > > > > > > {0x3103, 0x11, 0, 0}, {0x3008, 0x82, 0, 5}, {0x3008, 0x42, 0, 0}, > > > > > > - {0x3103, 0x03, 0, 0}, {0x3017, 0x00, 0, 0}, {0x3018, 0x00, 0, 0}, > > > > > > + {0x3103, 0x03, 0, 0}, > > > > > > {0x3630, 0x36, 0, 0}, > > > > > > Could you reflow this lines to not leave holes ? > > > > > Will do. > > > > Thank you > > > > > > > {0x3631, 0x0e, 0, 0}, {0x3632, 0xe2, 0, 0}, {0x3633, 0x12, 0, 0}, > > > > > > {0x3621, 0xe0, 0, 0}, {0x3704, 0xa0, 0, 0}, {0x3703, 0x5a, 0, 0}, > > > > > > @@ -1120,6 +1123,11 @@ static int ov5640_load_regs(struct ov5640_dev *sensor, > > > > > > val = regs->val; > > > > > > mask = regs->mask; > > > > > > > > > > > > + /* remain in power down mode for DVP */ > > > > > > + if (regs->reg_addr == OV5640_REG_SYS_CTRL0 && val == OV5640_SOFTWARE_WAKEUP && > > > > > > + sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > > > > > + continue; > > > > > > + > > > > > > I'm not yet convinced this is a good idea. This will cause the > > > ov5640_set_dvp() function to be called while the chip is still in > > > 'software power-down' mode. I tried to do the same for CSI-2 as well > > > and indeed I have LP-11 errors from the CSI-2 receiver, but then > > > capture works fine (puzzling! it might indicate that register values > > > as actually retained between software power up/down) > > > > > > This driver is such a mess I won't mind this 'special' dvp handling, > > > but it really puzzles me. > > > > > > From what I see here the bulk of this patch is about moving the > > > parallel bus configuration from s_stream() to s_power(), is this bit > > > here really required for that to work or is it a leftover ? Have you > > > tested it without the above hunk ? > > > > > Yes I have and it does work. but the idea behind this is to keep the > > sensor in powerdon mode all the time when nor streaming for DVP mode. > > > > I see, thanks for testing > > > > Paul, would you be able to test this series with your parallel setup > > > as well ? > > > > > > Also, if not strictly necessary, let's try to remain in the 80 cols limit. > > > > > OK. > > > > > > > > > > > if (mask) > > > > > > ret = ov5640_mod_reg(sensor, reg_addr, mask, val); > > > > > > else > > > > > > @@ -1210,96 +1218,8 @@ static int ov5640_set_autogain(struct ov5640_dev *sensor, bool on) > > > > > > > > > > > > static int ov5640_set_stream_dvp(struct ov5640_dev *sensor, bool on) > > > > > > { > > > > > > - int ret; > > > > > > - unsigned int flags = sensor->ep.bus.parallel.flags; > > > > > > - u8 pclk_pol = 0; > > > > > > - u8 hsync_pol = 0; > > > > > > - u8 vsync_pol = 0; > > > > > > - > > > > > > - /* > > > > > > - * Note about parallel port configuration. > > > > > > - * > > > > > > - * When configured in parallel mode, the OV5640 will > > > > > > - * output 10 bits data on DVP data lines [9:0]. > > > > > > - * If only 8 bits data are wanted, the 8 bits data lines > > > > > > - * of the camera interface must be physically connected > > > > > > - * on the DVP data lines [9:2]. > > > > > > - * > > > > > > - * Control lines polarity can be configured through > > > > > > - * devicetree endpoint control lines properties. > > > > > > - * If no endpoint control lines properties are set, > > > > > > - * polarity will be as below: > > > > > > - * - VSYNC: active high > > > > > > - * - HREF: active low > > > > > > - * - PCLK: active low > > > > > > - */ > > > > > > - > > > > > > - if (on) { > > > > > > - /* > > > > > > - * configure parallel port control lines polarity > > > > > > - * > > > > > > - * POLARITY CTRL0 > > > > > > - * - [5]: PCLK polarity (0: active low, 1: active high) > > > > > > - * - [1]: HREF polarity (0: active low, 1: active high) > > > > > > - * - [0]: VSYNC polarity (mismatch here between > > > > > > - * datasheet and hardware, 0 is active high > > > > > > - * and 1 is active low...) > > > > > > - */ > > > > > > - if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > > > > > - pclk_pol = 1; > > > > > > - if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > > > > > - hsync_pol = 1; > > > > > > - if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > > > > > - vsync_pol = 1; > > > > > > - > > > > > > - ret = ov5640_write_reg(sensor, > > > > > > - OV5640_REG_POLARITY_CTRL00, > > > > > > - (pclk_pol << 5) | > > > > > > - (hsync_pol << 1) | > > > > > > - vsync_pol); > > > > > > - > > > > > > - if (ret) > > > > > > - return ret; > > > > > > - } > > > > > > - > > > > > > - /* > > > > > > - * powerdown MIPI TX/RX PHY & disable MIPI > > > > > > - * > > > > > > - * MIPI CONTROL 00 > > > > > > - * 4: PWDN PHY TX > > > > > > - * 3: PWDN PHY RX > > > > > > - * 2: MIPI enable > > > > > > - */ > > > > > > - ret = ov5640_write_reg(sensor, > > > > > > - OV5640_REG_IO_MIPI_CTRL00, on ? 0x18 : 0); > > > > > > - if (ret) > > > > > > - return ret; > > > > > > - > > > > > > - /* > > > > > > - * enable VSYNC/HREF/PCLK DVP control lines > > > > > > - * & D[9:6] DVP data lines > > > > > > - * > > > > > > - * PAD OUTPUT ENABLE 01 > > > > > > - * - 6: VSYNC output enable > > > > > > - * - 5: HREF output enable > > > > > > - * - 4: PCLK output enable > > > > > > - * - [3:0]: D[9:6] output enable > > > > > > - */ > > > > > > - ret = ov5640_write_reg(sensor, > > > > > > - OV5640_REG_PAD_OUTPUT_ENABLE01, > > > > > > - on ? 0x7f : 0); > > > > > > - if (ret) > > > > > > - return ret; > > > > > > - > > > > > > - /* > > > > > > - * enable D[5:0] DVP data lines > > > > > > - * > > > > > > - * PAD OUTPUT ENABLE 02 > > > > > > - * - [7:2]: D[5:0] output enable > > > > > > - */ > > > > > > - return ov5640_write_reg(sensor, > > > > > > - OV5640_REG_PAD_OUTPUT_ENABLE02, > > > > > > - on ? 0xfc : 0); > > > > > > + return ov5640_write_reg(sensor, OV5640_REG_SYS_CTRL0, on ? > > > > > > + OV5640_SOFTWARE_WAKEUP : OV5640_SOFTWARE_PWDN); > > > > > > I'm surprised entering/exiting from what is called "Software power > > > down" in the chip manual retains the registers state! > > > > > In fact as part of the initial register sequence the sensor is put > > into power down mode, the required registers are set and then the > > sensor is woken up. > > > > That's funny. So the 'software power down' mode retains the internal > volatile memory content I assume. Nice to know and thanks for digging! > > > > > > > } > > > > > > > > > > > > static int ov5640_set_stream_mipi(struct ov5640_dev *sensor, bool on) > > > > > > @@ -2001,6 +1921,159 @@ static void ov5640_set_power_off(struct ov5640_dev *sensor) > > > > > > clk_disable_unprepare(sensor->xclk); > > > > > > } > > > > > > > > > > > > +static int ov5640_set_mipi(struct ov5640_dev *sensor, bool on) > > > > > > Maybe 'ov5640_set_power_mipi()' ? (same for dvp) > > > > > OK will replace it. > > > > Thanks > > > > > > > +{ > > > > > > + int ret = 0; > > > > > > + > > > > > > + if (!on) { > > > > > > + /* Reset MIPI bus settings to their default values. */ > > > > > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > > > > + ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x04); > > > > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x00); > > > > > > + > > > > > > + return ret; > > > > > > + } > > > > > > I know this was there already, but I wonder if this is now necessary > > > (same for the DVP counterpart). > > > > > > We call this from the power up/down routine, if we get here with on=1 > > > we are exiting from the chip powerdown mode and I expect registers to > > > be restored to their default values. > > > > > No waking up the sensor from power down mode doesnt restore the > > register to default values, infact it will retain the values which are > > already set to. Fyi I picked up the datasheet from [1] > > > > Careful here, I now understand 'software power down' might retain the > configuration, but this is called by in the s_power() call chain, > which powers the chip up/down by enabling and disabling clocks and > regulator and resetting the chip (see ov5640_set_power_on() which is called > before this function). > > I would really be surprised register values are retained after the > regulators have been shut off :) > Agreed disabling the clocks and regulators shouldnt re-store register contents :) > > [1] http://e2e.ti.com/cfs-file.ashx/__key/communityserver-discussions-components-files/100/2604.OV7725_5F00_CSP2_5F00_DS-_2800_1_5B00_1_5D00_.31_2900_.pdf > > Nice, but that's for ov7725 :) > Oops my bad here you go https://cdn.sparkfun.com/datasheets/Sensors/LightImaging/OV5640_datasheet.pdf Cheers, Prabhakar > Thanks > j > > > > > > > > > + > > > > > > + /* > > > > > > + * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > > > > > + * > > > > > > + * 0x300e = 0x40 > > > > > > + * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > > > > > + * "ov5640_set_stream_mipi()") > > > > > > + * [4] = 0 : Power up MIPI HS Tx > > > > > > + * [3] = 0 : Power up MIPI LS Rx > > > > > > + * [2] = 0 : MIPI interface disabled > > > > > > + */ > > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x40); > > > > > > + if (ret) > > > > > > + return ret; > > > > > > + > > > > > > + /* > > > > > > + * Gate clock and set LP11 in 'no packets mode' (idle) > > > > > > + * > > > > > > + * 0x4800 = 0x24 > > > > > > + * [5] = 1 : Gate clock when 'no packets' > > > > > > + * [2] = 1 : MIPI bus in LP11 when 'no packets' > > > > > > + */ > > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x24); > > > > > > + if (ret) > > > > > > + return ret; > > > > > > + > > > > > > + /* > > > > > > + * Set data lanes and clock in LP11 when 'sleeping' > > > > > > + * > > > > > > + * 0x3019 = 0x70 > > > > > > + * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > > > > > + * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > > > > > + * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > > > > > + */ > > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x70); > > > > > > + if (ret) > > > > > > + return ret; > > > > > > + > > > > > > + /* Give lanes some time to coax into LP11 state. */ > > > > > > + usleep_range(500, 1000); > > > > > > + > > > > > > + return 0; > > > > > > +} > > > > > > + > > > > > > +static int ov5640_set_dvp(struct ov5640_dev *sensor, bool on) > > > > > > +{ > > > > > > + unsigned int flags = sensor->ep.bus.parallel.flags; > > > > > > + u8 pclk_pol = 0; > > > > > > + u8 hsync_pol = 0; > > > > > > + u8 vsync_pol = 0; > > > > > > + int ret = 0; > > > > > > + > > > > > > + if (!on) { > > > > > > + /* Reset settings to their default values. */ > > > > > > + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > > > > + ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, 0x20); > > > > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x00); > > > > > > + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0x00); > > > > > > + > > > > > > + return ret; > > > > > > + } > > > > > > + > > > > > > + /* > > > > > > + * Note about parallel port configuration. > > > > > > + * > > > > > > + * When configured in parallel mode, the OV5640 will > > > > > > + * output 10 bits data on DVP data lines [9:0]. > > > > > > + * If only 8 bits data are wanted, the 8 bits data lines > > > > > > + * of the camera interface must be physically connected > > > > > > + * on the DVP data lines [9:2]. > > > > > > + * > > > > > > + * Control lines polarity can be configured through > > > > > > + * devicetree endpoint control lines properties. > > > > > > + * If no endpoint control lines properties are set, > > > > > > + * polarity will be as below: > > > > > > + * - VSYNC: active high > > > > > > + * - HREF: active low > > > > > > + * - PCLK: active low > > > > > > + */ > > > > > > + /* > > > > > > + * configure parallel port control lines polarity > > > > > > + * > > > > > > + * POLARITY CTRL0 > > > > > > + * - [5]: PCLK polarity (0: active low, 1: active high) > > > > > > + * - [1]: HREF polarity (0: active low, 1: active high) > > > > > > + * - [0]: VSYNC polarity (mismatch here between > > > > > > + * datasheet and hardware, 0 is active high > > > > > > + * and 1 is active low...) > > > > > > + */ > > > > > > + if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) > > > > > > + pclk_pol = 1; > > > > > > + if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) > > > > > > + hsync_pol = 1; > > > > > > + if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) > > > > > > + vsync_pol = 1; > > > > > > + > > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, > > > > > > + (pclk_pol << 5) | (hsync_pol << 1) | vsync_pol); > > > > > > + > > > > > > + if (ret) > > > > > > + return ret; > > > > > > + > > > > > > + /* > > > > > > + * powerdown MIPI TX/RX PHY & disable MIPI > > > > > > + * > > > > > > + * MIPI CONTROL 00 > > > > > > + * 4: PWDN PHY TX > > > > > > + * 3: PWDN PHY RX > > > > > > + * 2: MIPI enable > > > > > > + */ > > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x18); > > > > > > + if (ret) > > > > > > + return ret; > > > > > > + > > > > > > + /* > > > > > > + * enable VSYNC/HREF/PCLK DVP control lines > > > > > > + * & D[9:6] DVP data lines > > > > > > + * > > > > > > + * PAD OUTPUT ENABLE 01 > > > > > > + * - 6: VSYNC output enable > > > > > > + * - 5: HREF output enable > > > > > > + * - 4: PCLK output enable > > > > > > + * - [3:0]: D[9:6] output enable > > > > > > + */ > > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x7f); > > > > > > + if (ret) > > > > > > + return ret; > > > > > > + > > > > > > + /* > > > > > > + * enable D[5:0] DVP data lines > > > > > > + * > > > > > > + * PAD OUTPUT ENABLE 02 > > > > > > + * - [7:2]: D[5:0] output enable > > > > > > + */ > > > > > > + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0xfc); > > > > > > + if (ret) > > > > > > + return ret; > > > > > > + > > > > > > + return 0; > > > > > > +} > > > > > > + > > > > > > static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > > > > > { > > > > > > int ret = 0; > > > > > > @@ -2013,67 +2086,17 @@ static int ov5640_set_power(struct ov5640_dev *sensor, bool on) > > > > > > ret = ov5640_restore_mode(sensor); > > > > > > if (ret) > > > > > > goto power_off; > > > > > > + } > > > > > > > > > > > > - /* We're done here for DVP bus, while CSI-2 needs setup. */ > > > > > > - if (sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) > > > > > > - return 0; > > > > > > - > > > > > > - /* > > > > > > - * Power up MIPI HS Tx and LS Rx; 2 data lanes mode > > > > > > - * > > > > > > - * 0x300e = 0x40 > > > > > > - * [7:5] = 010 : 2 data lanes mode (see FIXME note in > > > > > > - * "ov5640_set_stream_mipi()") > > > > > > - * [4] = 0 : Power up MIPI HS Tx > > > > > > - * [3] = 0 : Power up MIPI LS Rx > > > > > > - * [2] = 0 : MIPI interface disabled > > > > > > - */ > > > > > > - ret = ov5640_write_reg(sensor, > > > > > > - OV5640_REG_IO_MIPI_CTRL00, 0x40); > > > > > > - if (ret) > > > > > > - goto power_off; > > > > > > - > > > > > > - /* > > > > > > - * Gate clock and set LP11 in 'no packets mode' (idle) > > > > > > - * > > > > > > - * 0x4800 = 0x24 > > > > > > - * [5] = 1 : Gate clock when 'no packets' > > > > > > - * [2] = 1 : MIPI bus in LP11 when 'no packets' > > > > > > - */ > > > > > > - ret = ov5640_write_reg(sensor, > > > > > > - OV5640_REG_MIPI_CTRL00, 0x24); > > > > > > - if (ret) > > > > > > - goto power_off; > > > > > > - > > > > > > - /* > > > > > > - * Set data lanes and clock in LP11 when 'sleeping' > > > > > > - * > > > > > > - * 0x3019 = 0x70 > > > > > > - * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' > > > > > > - * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' > > > > > > - * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' > > > > > > - */ > > > > > > - ret = ov5640_write_reg(sensor, > > > > > > - OV5640_REG_PAD_OUTPUT00, 0x70); > > > > > > - if (ret) > > > > > > - goto power_off; > > > > > > - > > > > > > - /* Give lanes some time to coax into LP11 state. */ > > > > > > - usleep_range(500, 1000); > > > > > > - > > > > > > - } else { > > > > > > - if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) { > > > > > > - /* Reset MIPI bus settings to their default values. */ > > > > > > - ov5640_write_reg(sensor, > > > > > > - OV5640_REG_IO_MIPI_CTRL00, 0x58); > > > > > > - ov5640_write_reg(sensor, > > > > > > - OV5640_REG_MIPI_CTRL00, 0x04); > > > > > > - ov5640_write_reg(sensor, > > > > > > - OV5640_REG_PAD_OUTPUT00, 0x00); > > > > > > - } > > > > > > + if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) > > > > > > + ret = ov5640_set_mipi(sensor, on); > > > > > > + else > > > > > > + ret = ov5640_set_dvp(sensor, on); > > > > > > + if (ret) > > > > > > + goto power_off; > > > > > > If you agree the if (!on) case in the two set_mipi()/set_dvp() functions > > > above can be removed, this function should become > > > > > I would keep it, as mentioned above. > > > > Cheers, > > Prabhakar
diff --git a/drivers/media/i2c/ov5640.c b/drivers/media/i2c/ov5640.c index 2fe4a7ac0592..ec444bee2ce9 100644 --- a/drivers/media/i2c/ov5640.c +++ b/drivers/media/i2c/ov5640.c @@ -94,6 +94,9 @@ #define OV5640_REG_SDE_CTRL5 0x5585 #define OV5640_REG_AVG_READOUT 0x56a1 +#define OV5640_SOFTWARE_PWDN 0x42 +#define OV5640_SOFTWARE_WAKEUP 0x02 + enum ov5640_mode_id { OV5640_MODE_QCIF_176_144 = 0, OV5640_MODE_QVGA_320_240, @@ -274,7 +277,7 @@ static inline struct v4l2_subdev *ctrl_to_sd(struct v4l2_ctrl *ctrl) /* YUV422 UYVY VGA@30fps */ static const struct reg_value ov5640_init_setting_30fps_VGA[] = { {0x3103, 0x11, 0, 0}, {0x3008, 0x82, 0, 5}, {0x3008, 0x42, 0, 0}, - {0x3103, 0x03, 0, 0}, {0x3017, 0x00, 0, 0}, {0x3018, 0x00, 0, 0}, + {0x3103, 0x03, 0, 0}, {0x3630, 0x36, 0, 0}, {0x3631, 0x0e, 0, 0}, {0x3632, 0xe2, 0, 0}, {0x3633, 0x12, 0, 0}, {0x3621, 0xe0, 0, 0}, {0x3704, 0xa0, 0, 0}, {0x3703, 0x5a, 0, 0}, @@ -1120,6 +1123,11 @@ static int ov5640_load_regs(struct ov5640_dev *sensor, val = regs->val; mask = regs->mask; + /* remain in power down mode for DVP */ + if (regs->reg_addr == OV5640_REG_SYS_CTRL0 && val == OV5640_SOFTWARE_WAKEUP && + sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) + continue; + if (mask) ret = ov5640_mod_reg(sensor, reg_addr, mask, val); else @@ -1210,96 +1218,8 @@ static int ov5640_set_autogain(struct ov5640_dev *sensor, bool on) static int ov5640_set_stream_dvp(struct ov5640_dev *sensor, bool on) { - int ret; - unsigned int flags = sensor->ep.bus.parallel.flags; - u8 pclk_pol = 0; - u8 hsync_pol = 0; - u8 vsync_pol = 0; - - /* - * Note about parallel port configuration. - * - * When configured in parallel mode, the OV5640 will - * output 10 bits data on DVP data lines [9:0]. - * If only 8 bits data are wanted, the 8 bits data lines - * of the camera interface must be physically connected - * on the DVP data lines [9:2]. - * - * Control lines polarity can be configured through - * devicetree endpoint control lines properties. - * If no endpoint control lines properties are set, - * polarity will be as below: - * - VSYNC: active high - * - HREF: active low - * - PCLK: active low - */ - - if (on) { - /* - * configure parallel port control lines polarity - * - * POLARITY CTRL0 - * - [5]: PCLK polarity (0: active low, 1: active high) - * - [1]: HREF polarity (0: active low, 1: active high) - * - [0]: VSYNC polarity (mismatch here between - * datasheet and hardware, 0 is active high - * and 1 is active low...) - */ - if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) - pclk_pol = 1; - if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) - hsync_pol = 1; - if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) - vsync_pol = 1; - - ret = ov5640_write_reg(sensor, - OV5640_REG_POLARITY_CTRL00, - (pclk_pol << 5) | - (hsync_pol << 1) | - vsync_pol); - - if (ret) - return ret; - } - - /* - * powerdown MIPI TX/RX PHY & disable MIPI - * - * MIPI CONTROL 00 - * 4: PWDN PHY TX - * 3: PWDN PHY RX - * 2: MIPI enable - */ - ret = ov5640_write_reg(sensor, - OV5640_REG_IO_MIPI_CTRL00, on ? 0x18 : 0); - if (ret) - return ret; - - /* - * enable VSYNC/HREF/PCLK DVP control lines - * & D[9:6] DVP data lines - * - * PAD OUTPUT ENABLE 01 - * - 6: VSYNC output enable - * - 5: HREF output enable - * - 4: PCLK output enable - * - [3:0]: D[9:6] output enable - */ - ret = ov5640_write_reg(sensor, - OV5640_REG_PAD_OUTPUT_ENABLE01, - on ? 0x7f : 0); - if (ret) - return ret; - - /* - * enable D[5:0] DVP data lines - * - * PAD OUTPUT ENABLE 02 - * - [7:2]: D[5:0] output enable - */ - return ov5640_write_reg(sensor, - OV5640_REG_PAD_OUTPUT_ENABLE02, - on ? 0xfc : 0); + return ov5640_write_reg(sensor, OV5640_REG_SYS_CTRL0, on ? + OV5640_SOFTWARE_WAKEUP : OV5640_SOFTWARE_PWDN); } static int ov5640_set_stream_mipi(struct ov5640_dev *sensor, bool on) @@ -2001,6 +1921,159 @@ static void ov5640_set_power_off(struct ov5640_dev *sensor) clk_disable_unprepare(sensor->xclk); } +static int ov5640_set_mipi(struct ov5640_dev *sensor, bool on) +{ + int ret = 0; + + if (!on) { + /* Reset MIPI bus settings to their default values. */ + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); + ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x04); + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x00); + + return ret; + } + + /* + * Power up MIPI HS Tx and LS Rx; 2 data lanes mode + * + * 0x300e = 0x40 + * [7:5] = 010 : 2 data lanes mode (see FIXME note in + * "ov5640_set_stream_mipi()") + * [4] = 0 : Power up MIPI HS Tx + * [3] = 0 : Power up MIPI LS Rx + * [2] = 0 : MIPI interface disabled + */ + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x40); + if (ret) + return ret; + + /* + * Gate clock and set LP11 in 'no packets mode' (idle) + * + * 0x4800 = 0x24 + * [5] = 1 : Gate clock when 'no packets' + * [2] = 1 : MIPI bus in LP11 when 'no packets' + */ + ret = ov5640_write_reg(sensor, OV5640_REG_MIPI_CTRL00, 0x24); + if (ret) + return ret; + + /* + * Set data lanes and clock in LP11 when 'sleeping' + * + * 0x3019 = 0x70 + * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' + * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' + * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' + */ + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT00, 0x70); + if (ret) + return ret; + + /* Give lanes some time to coax into LP11 state. */ + usleep_range(500, 1000); + + return 0; +} + +static int ov5640_set_dvp(struct ov5640_dev *sensor, bool on) +{ + unsigned int flags = sensor->ep.bus.parallel.flags; + u8 pclk_pol = 0; + u8 hsync_pol = 0; + u8 vsync_pol = 0; + int ret = 0; + + if (!on) { + /* Reset settings to their default values. */ + ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x58); + ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, 0x20); + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x00); + ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0x00); + + return ret; + } + + /* + * Note about parallel port configuration. + * + * When configured in parallel mode, the OV5640 will + * output 10 bits data on DVP data lines [9:0]. + * If only 8 bits data are wanted, the 8 bits data lines + * of the camera interface must be physically connected + * on the DVP data lines [9:2]. + * + * Control lines polarity can be configured through + * devicetree endpoint control lines properties. + * If no endpoint control lines properties are set, + * polarity will be as below: + * - VSYNC: active high + * - HREF: active low + * - PCLK: active low + */ + /* + * configure parallel port control lines polarity + * + * POLARITY CTRL0 + * - [5]: PCLK polarity (0: active low, 1: active high) + * - [1]: HREF polarity (0: active low, 1: active high) + * - [0]: VSYNC polarity (mismatch here between + * datasheet and hardware, 0 is active high + * and 1 is active low...) + */ + if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) + pclk_pol = 1; + if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) + hsync_pol = 1; + if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) + vsync_pol = 1; + + ret = ov5640_write_reg(sensor, OV5640_REG_POLARITY_CTRL00, + (pclk_pol << 5) | (hsync_pol << 1) | vsync_pol); + + if (ret) + return ret; + + /* + * powerdown MIPI TX/RX PHY & disable MIPI + * + * MIPI CONTROL 00 + * 4: PWDN PHY TX + * 3: PWDN PHY RX + * 2: MIPI enable + */ + ret = ov5640_write_reg(sensor, OV5640_REG_IO_MIPI_CTRL00, 0x18); + if (ret) + return ret; + + /* + * enable VSYNC/HREF/PCLK DVP control lines + * & D[9:6] DVP data lines + * + * PAD OUTPUT ENABLE 01 + * - 6: VSYNC output enable + * - 5: HREF output enable + * - 4: PCLK output enable + * - [3:0]: D[9:6] output enable + */ + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE01, 0x7f); + if (ret) + return ret; + + /* + * enable D[5:0] DVP data lines + * + * PAD OUTPUT ENABLE 02 + * - [7:2]: D[5:0] output enable + */ + ret = ov5640_write_reg(sensor, OV5640_REG_PAD_OUTPUT_ENABLE02, 0xfc); + if (ret) + return ret; + + return 0; +} + static int ov5640_set_power(struct ov5640_dev *sensor, bool on) { int ret = 0; @@ -2013,67 +2086,17 @@ static int ov5640_set_power(struct ov5640_dev *sensor, bool on) ret = ov5640_restore_mode(sensor); if (ret) goto power_off; + } - /* We're done here for DVP bus, while CSI-2 needs setup. */ - if (sensor->ep.bus_type != V4L2_MBUS_CSI2_DPHY) - return 0; - - /* - * Power up MIPI HS Tx and LS Rx; 2 data lanes mode - * - * 0x300e = 0x40 - * [7:5] = 010 : 2 data lanes mode (see FIXME note in - * "ov5640_set_stream_mipi()") - * [4] = 0 : Power up MIPI HS Tx - * [3] = 0 : Power up MIPI LS Rx - * [2] = 0 : MIPI interface disabled - */ - ret = ov5640_write_reg(sensor, - OV5640_REG_IO_MIPI_CTRL00, 0x40); - if (ret) - goto power_off; - - /* - * Gate clock and set LP11 in 'no packets mode' (idle) - * - * 0x4800 = 0x24 - * [5] = 1 : Gate clock when 'no packets' - * [2] = 1 : MIPI bus in LP11 when 'no packets' - */ - ret = ov5640_write_reg(sensor, - OV5640_REG_MIPI_CTRL00, 0x24); - if (ret) - goto power_off; - - /* - * Set data lanes and clock in LP11 when 'sleeping' - * - * 0x3019 = 0x70 - * [6] = 1 : MIPI data lane 2 in LP11 when 'sleeping' - * [5] = 1 : MIPI data lane 1 in LP11 when 'sleeping' - * [4] = 1 : MIPI clock lane in LP11 when 'sleeping' - */ - ret = ov5640_write_reg(sensor, - OV5640_REG_PAD_OUTPUT00, 0x70); - if (ret) - goto power_off; - - /* Give lanes some time to coax into LP11 state. */ - usleep_range(500, 1000); - - } else { - if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) { - /* Reset MIPI bus settings to their default values. */ - ov5640_write_reg(sensor, - OV5640_REG_IO_MIPI_CTRL00, 0x58); - ov5640_write_reg(sensor, - OV5640_REG_MIPI_CTRL00, 0x04); - ov5640_write_reg(sensor, - OV5640_REG_PAD_OUTPUT00, 0x00); - } + if (sensor->ep.bus_type == V4L2_MBUS_CSI2_DPHY) + ret = ov5640_set_mipi(sensor, on); + else + ret = ov5640_set_dvp(sensor, on); + if (ret) + goto power_off; + if (!on) ov5640_set_power_off(sensor); - } return 0;