Re: [PATCH] [media] ov5645: I2C address change

[Laurent Pinchart]

CC'ing the I2C mainling list and the I2C maintainer.

On Wednesday, 4 October 2017 13:30:08 EEST Sakari Ailus wrote:
> Hi Todor,
> 
> On Mon, Oct 02, 2017 at 04:28:45PM +0300, Todor Tomov wrote:
> > As soon as the sensor is powered on, change the I2C address to the one
> > specified in DT. This allows to use multiple physical sensors connected
> > to the same I2C bus.
> > 
> > Signed-off-by: Todor Tomov <todor.tomov@xxxxxxxxxx>
> 
> The smiapp driver does something similar and I understand Laurent might be
> interested in such functionality as well.
> 
> It'd be nice to handle this through the I²C framework instead and to define
> how the information is specified through DT. That way it could be made
> generic, to work with more devices than just this one.
> 
> What do you think?
> 
> Cc Laurent.
> 
> > ---
> > 
> >  drivers/media/i2c/ov5645.c | 42 ++++++++++++++++++++++++++++++++++++++++
> >  1 file changed, 42 insertions(+)
> > 
> > diff --git a/drivers/media/i2c/ov5645.c b/drivers/media/i2c/ov5645.c
> > index d28845f..8541109 100644
> > --- a/drivers/media/i2c/ov5645.c
> > +++ b/drivers/media/i2c/ov5645.c
> > @@ -33,6 +33,7 @@
> >  #include <linux/i2c.h>
> >  #include <linux/init.h>
> >  #include <linux/module.h>
> > +#include <linux/mutex.h>
> >  #include <linux/of.h>
> >  #include <linux/of_graph.h>
> >  #include <linux/regulator/consumer.h>
> > @@ -42,6 +43,8 @@
> >  #include <media/v4l2-fwnode.h>
> >  #include <media/v4l2-subdev.h>
> > 
> > +static DEFINE_MUTEX(ov5645_lock);
> > +
> >  #define OV5645_VOLTAGE_ANALOG               2800000
> >  #define OV5645_VOLTAGE_DIGITAL_CORE         1500000
> >  #define OV5645_VOLTAGE_DIGITAL_IO           1800000
> > @@ -590,6 +593,31 @@ static void ov5645_regulators_disable(struct ov5645
> > *ov5645)
> >  		dev_err(ov5645->dev, "io regulator disable failed\n");
> >  }
> > 
> > +static int ov5645_write_reg_to(struct ov5645 *ov5645, u16 reg, u8 val,
> > +			       u16 i2c_addr)
> > +{
> > +	u8 regbuf[3] = {
> > +		reg >> 8,
> > +		reg & 0xff,
> > +		val
> > +	};
> > +	struct i2c_msg msgs = {
> > +		.addr = i2c_addr,
> > +		.flags = 0,
> > +		.len = 3,
> > +		.buf = regbuf
> > +	};
> > +	int ret;
> > +
> > +	ret = i2c_transfer(ov5645->i2c_client->adapter, &msgs, 1);
> > +	if (ret < 0)
> > +		dev_err(ov5645->dev,
> > +			"%s: write reg error %d on addr 0x%x: reg=0x%x, val=0x%x\n",
> > +			__func__, ret, i2c_addr, reg, val);
> > +
> > +	return ret;
> > +}
> > +
> >  static int ov5645_write_reg(struct ov5645 *ov5645, u16 reg, u8 val)
> >  {
> >  	u8 regbuf[3];
> > @@ -729,10 +757,24 @@ static int ov5645_s_power(struct v4l2_subdev *sd,
> > int on)
> >  	 */
> >  	if (ov5645->power_count == !on) {
> >  		if (on) {
> > +			mutex_lock(&ov5645_lock);
> > +
> >  			ret = ov5645_set_power_on(ov5645);
> >  			if (ret < 0)
> >  				goto exit;
> > 
> > +			ret = ov5645_write_reg_to(ov5645, 0x3100,
> > +						ov5645->i2c_client->addr, 0x78);
> > +			if (ret < 0) {
> > +				dev_err(ov5645->dev,
> > +					"could not change i2c address\n");
> > +				ov5645_set_power_off(ov5645);
> > +				mutex_unlock(&ov5645_lock);
> > +				goto exit;
> > +			}
> > +
> > +			mutex_unlock(&ov5645_lock);
> > +
> >  			ret = ov5645_set_register_array(ov5645,
> >  					ov5645_global_init_setting,
> >  					ARRAY_SIZE(ov5645_global_init_setting));

-- 
Regards,

Laurent Pinchart