Re: [PATCH 07/19] media: i2c: imx290: Support variable-sized registers

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



Hi Alexander,

On Thu, Jul 21, 2022 at 11:43:47AM +0200, Alexander Stein wrote:
> Am Donnerstag, 21. Juli 2022, 10:35:28 CEST schrieb Laurent Pinchart:
> > The IMX290 has registers of different sizes. To simplify the code,
> > handle this in the read/write functions instead of in the callers by
> > encoding the register size in the symbolic name macros. All registers
> > are defined as 8-bit for now, a subsequent change will move to larger
> > registers where applicable.
> > 
> > Signed-off-by: Laurent Pinchart <laurent.pinchart@xxxxxxxxxxxxxxxx>
> > ---
> >  drivers/media/i2c/imx290.c | 352 +++++++++++++++++++------------------
> >  1 file changed, 180 insertions(+), 172 deletions(-)
> > 
> > diff --git a/drivers/media/i2c/imx290.c b/drivers/media/i2c/imx290.c
> > index 711282126c34..ac58bfe6db7f 100644
> > --- a/drivers/media/i2c/imx290.c
> > +++ b/drivers/media/i2c/imx290.c
> > @@ -22,22 +22,28 @@
> >  #include <media/v4l2-fwnode.h>
> >  #include <media/v4l2-subdev.h>
> > 
> > -#define IMX290_STANDBY 0x3000
> > -#define IMX290_REGHOLD 0x3001
> > -#define IMX290_XMSTA 0x3002
> > -#define IMX290_FR_FDG_SEL 0x3009
> > -#define IMX290_BLKLEVEL_LOW 0x300a
> > -#define IMX290_BLKLEVEL_HIGH 0x300b
> > -#define IMX290_GAIN 0x3014
> > -#define IMX290_HMAX_LOW 0x301c
> > -#define IMX290_HMAX_HIGH 0x301d
> > -#define IMX290_PGCTRL 0x308c
> > -#define IMX290_PHY_LANE_NUM 0x3407
> > -#define IMX290_CSI_LANE_MODE 0x3443
> > +#define IMX290_REG_8BIT(n)				((1 << 16) | (n))
> > +#define IMX290_REG_16BIT(n)				((2 << 16) | (n))
> > +#define IMX290_REG_24BIT(n)				((3 << 16) | (n))
> 
> IMX290_REG_SIZE_SHIFT instead of 16 here? Not exactly necessary, but use
> 1U, 2U and 3U instead.

I'll fix that.

> > +#define IMX290_REG_SIZE_SHIFT				16
> > +#define IMX290_REG_ADDR_MASK				0xffff
> > 
> > -#define IMX290_PGCTRL_REGEN BIT(0)
> > -#define IMX290_PGCTRL_THRU BIT(1)
> > -#define IMX290_PGCTRL_MODE(n) ((n) << 4)
> > +#define IMX290_STANDBY					IMX290_REG_8BIT(0x3000)
> > +#define IMX290_REGHOLD					IMX290_REG_8BIT(0x3001)
> > +#define IMX290_XMSTA					IMX290_REG_8BIT(0x3002)
> > +#define IMX290_FR_FDG_SEL				IMX290_REG_8BIT(0x3009)
> > +#define IMX290_BLKLEVEL_LOW				IMX290_REG_8BIT(0x300a)
> > +#define IMX290_BLKLEVEL_HIGH				IMX290_REG_8BIT(0x300b)
> > +#define IMX290_GAIN					IMX290_REG_8BIT(0x3014)
> > +#define IMX290_HMAX_LOW					IMX290_REG_8BIT(0x301c)
> > +#define IMX290_HMAX_HIGH				IMX290_REG_8BIT(0x301d)
> > +#define IMX290_PGCTRL					IMX290_REG_8BIT(0x308c)
> > +#define IMX290_PHY_LANE_NUM				IMX290_REG_8BIT(0x3407)
> > +#define IMX290_CSI_LANE_MODE				IMX290_REG_8BIT(0x3443)
> > +
> > +#define IMX290_PGCTRL_REGEN				BIT(0)
> > +#define IMX290_PGCTRL_THRU				BIT(1)
> > +#define IMX290_PGCTRL_MODE(n)				((n) << 4)
> > 
> >  static const char * const imx290_supply_name[] = {
> >  	"vdda",
> > @@ -48,7 +54,7 @@ static const char * const imx290_supply_name[] = {
> >  #define IMX290_NUM_SUPPLIES ARRAY_SIZE(imx290_supply_name)
> > 
> >  struct imx290_regval {
> > -	u16 reg;
> > +	u32 reg;
> >  	u8 val;
> >  };
> > 
> > @@ -111,163 +117,163 @@ static const char * const imx290_test_pattern_menu[]
> > = { };
> > 
> >  static const struct imx290_regval imx290_global_init_settings[] = {
> > -	{ 0x3007, 0x00 },
> > -	{ 0x3018, 0x65 },
> > -	{ 0x3019, 0x04 },
> > -	{ 0x301a, 0x00 },
> > -	{ 0x3444, 0x20 },
> > -	{ 0x3445, 0x25 },
> > -	{ 0x303a, 0x0c },
> > -	{ 0x3040, 0x00 },
> > -	{ 0x3041, 0x00 },
> > -	{ 0x303c, 0x00 },
> > -	{ 0x303d, 0x00 },
> > -	{ 0x3042, 0x9c },
> > -	{ 0x3043, 0x07 },
> > -	{ 0x303e, 0x49 },
> > -	{ 0x303f, 0x04 },
> > -	{ 0x304b, 0x0a },
> > -	{ 0x300f, 0x00 },
> > -	{ 0x3010, 0x21 },
> > -	{ 0x3012, 0x64 },
> > -	{ 0x3016, 0x09 },
> > -	{ 0x3070, 0x02 },
> > -	{ 0x3071, 0x11 },
> > -	{ 0x309b, 0x10 },
> > -	{ 0x309c, 0x22 },
> > -	{ 0x30a2, 0x02 },
> > -	{ 0x30a6, 0x20 },
> > -	{ 0x30a8, 0x20 },
> > -	{ 0x30aa, 0x20 },
> > -	{ 0x30ac, 0x20 },
> > -	{ 0x30b0, 0x43 },
> > -	{ 0x3119, 0x9e },
> > -	{ 0x311c, 0x1e },
> > -	{ 0x311e, 0x08 },
> > -	{ 0x3128, 0x05 },
> > -	{ 0x313d, 0x83 },
> > -	{ 0x3150, 0x03 },
> > -	{ 0x317e, 0x00 },
> > -	{ 0x32b8, 0x50 },
> > -	{ 0x32b9, 0x10 },
> > -	{ 0x32ba, 0x00 },
> > -	{ 0x32bb, 0x04 },
> > -	{ 0x32c8, 0x50 },
> > -	{ 0x32c9, 0x10 },
> > -	{ 0x32ca, 0x00 },
> > -	{ 0x32cb, 0x04 },
> > -	{ 0x332c, 0xd3 },
> > -	{ 0x332d, 0x10 },
> > -	{ 0x332e, 0x0d },
> > -	{ 0x3358, 0x06 },
> > -	{ 0x3359, 0xe1 },
> > -	{ 0x335a, 0x11 },
> > -	{ 0x3360, 0x1e },
> > -	{ 0x3361, 0x61 },
> > -	{ 0x3362, 0x10 },
> > -	{ 0x33b0, 0x50 },
> > -	{ 0x33b2, 0x1a },
> > -	{ 0x33b3, 0x04 },
> > +	{ IMX290_REG_8BIT(0x3007), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3018), 0x65 },
> > +	{ IMX290_REG_8BIT(0x3019), 0x04 },
> > +	{ IMX290_REG_8BIT(0x301a), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3444), 0x20 },
> > +	{ IMX290_REG_8BIT(0x3445), 0x25 },
> > +	{ IMX290_REG_8BIT(0x303a), 0x0c },
> > +	{ IMX290_REG_8BIT(0x3040), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3041), 0x00 },
> > +	{ IMX290_REG_8BIT(0x303c), 0x00 },
> > +	{ IMX290_REG_8BIT(0x303d), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3042), 0x9c },
> > +	{ IMX290_REG_8BIT(0x3043), 0x07 },
> > +	{ IMX290_REG_8BIT(0x303e), 0x49 },
> > +	{ IMX290_REG_8BIT(0x303f), 0x04 },
> > +	{ IMX290_REG_8BIT(0x304b), 0x0a },
> > +	{ IMX290_REG_8BIT(0x300f), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3010), 0x21 },
> > +	{ IMX290_REG_8BIT(0x3012), 0x64 },
> > +	{ IMX290_REG_8BIT(0x3016), 0x09 },
> > +	{ IMX290_REG_8BIT(0x3070), 0x02 },
> > +	{ IMX290_REG_8BIT(0x3071), 0x11 },
> > +	{ IMX290_REG_8BIT(0x309b), 0x10 },
> > +	{ IMX290_REG_8BIT(0x309c), 0x22 },
> > +	{ IMX290_REG_8BIT(0x30a2), 0x02 },
> > +	{ IMX290_REG_8BIT(0x30a6), 0x20 },
> > +	{ IMX290_REG_8BIT(0x30a8), 0x20 },
> > +	{ IMX290_REG_8BIT(0x30aa), 0x20 },
> > +	{ IMX290_REG_8BIT(0x30ac), 0x20 },
> > +	{ IMX290_REG_8BIT(0x30b0), 0x43 },
> > +	{ IMX290_REG_8BIT(0x3119), 0x9e },
> > +	{ IMX290_REG_8BIT(0x311c), 0x1e },
> > +	{ IMX290_REG_8BIT(0x311e), 0x08 },
> > +	{ IMX290_REG_8BIT(0x3128), 0x05 },
> > +	{ IMX290_REG_8BIT(0x313d), 0x83 },
> > +	{ IMX290_REG_8BIT(0x3150), 0x03 },
> > +	{ IMX290_REG_8BIT(0x317e), 0x00 },
> > +	{ IMX290_REG_8BIT(0x32b8), 0x50 },
> > +	{ IMX290_REG_8BIT(0x32b9), 0x10 },
> > +	{ IMX290_REG_8BIT(0x32ba), 0x00 },
> > +	{ IMX290_REG_8BIT(0x32bb), 0x04 },
> > +	{ IMX290_REG_8BIT(0x32c8), 0x50 },
> > +	{ IMX290_REG_8BIT(0x32c9), 0x10 },
> > +	{ IMX290_REG_8BIT(0x32ca), 0x00 },
> > +	{ IMX290_REG_8BIT(0x32cb), 0x04 },
> > +	{ IMX290_REG_8BIT(0x332c), 0xd3 },
> > +	{ IMX290_REG_8BIT(0x332d), 0x10 },
> > +	{ IMX290_REG_8BIT(0x332e), 0x0d },
> > +	{ IMX290_REG_8BIT(0x3358), 0x06 },
> > +	{ IMX290_REG_8BIT(0x3359), 0xe1 },
> > +	{ IMX290_REG_8BIT(0x335a), 0x11 },
> > +	{ IMX290_REG_8BIT(0x3360), 0x1e },
> > +	{ IMX290_REG_8BIT(0x3361), 0x61 },
> > +	{ IMX290_REG_8BIT(0x3362), 0x10 },
> > +	{ IMX290_REG_8BIT(0x33b0), 0x50 },
> > +	{ IMX290_REG_8BIT(0x33b2), 0x1a },
> > +	{ IMX290_REG_8BIT(0x33b3), 0x04 },
> >  };
> > 
> >  static const struct imx290_regval imx290_1080p_settings[] = {
> >  	/* mode settings */
> > -	{ 0x3007, 0x00 },
> > -	{ 0x303a, 0x0c },
> > -	{ 0x3414, 0x0a },
> > -	{ 0x3472, 0x80 },
> > -	{ 0x3473, 0x07 },
> > -	{ 0x3418, 0x38 },
> > -	{ 0x3419, 0x04 },
> > -	{ 0x3012, 0x64 },
> > -	{ 0x3013, 0x00 },
> > -	{ 0x305c, 0x18 },
> > -	{ 0x305d, 0x03 },
> > -	{ 0x305e, 0x20 },
> > -	{ 0x305f, 0x01 },
> > -	{ 0x315e, 0x1a },
> > -	{ 0x3164, 0x1a },
> > -	{ 0x3480, 0x49 },
> > +	{ IMX290_REG_8BIT(0x3007), 0x00 },
> > +	{ IMX290_REG_8BIT(0x303a), 0x0c },
> > +	{ IMX290_REG_8BIT(0x3414), 0x0a },
> > +	{ IMX290_REG_8BIT(0x3472), 0x80 },
> > +	{ IMX290_REG_8BIT(0x3473), 0x07 },
> > +	{ IMX290_REG_8BIT(0x3418), 0x38 },
> > +	{ IMX290_REG_8BIT(0x3419), 0x04 },
> > +	{ IMX290_REG_8BIT(0x3012), 0x64 },
> > +	{ IMX290_REG_8BIT(0x3013), 0x00 },
> > +	{ IMX290_REG_8BIT(0x305c), 0x18 },
> > +	{ IMX290_REG_8BIT(0x305d), 0x03 },
> > +	{ IMX290_REG_8BIT(0x305e), 0x20 },
> > +	{ IMX290_REG_8BIT(0x305f), 0x01 },
> > +	{ IMX290_REG_8BIT(0x315e), 0x1a },
> > +	{ IMX290_REG_8BIT(0x3164), 0x1a },
> > +	{ IMX290_REG_8BIT(0x3480), 0x49 },
> >  	/* data rate settings */
> > -	{ 0x3405, 0x10 },
> > -	{ 0x3446, 0x57 },
> > -	{ 0x3447, 0x00 },
> > -	{ 0x3448, 0x37 },
> > -	{ 0x3449, 0x00 },
> > -	{ 0x344a, 0x1f },
> > -	{ 0x344b, 0x00 },
> > -	{ 0x344c, 0x1f },
> > -	{ 0x344d, 0x00 },
> > -	{ 0x344e, 0x1f },
> > -	{ 0x344f, 0x00 },
> > -	{ 0x3450, 0x77 },
> > -	{ 0x3451, 0x00 },
> > -	{ 0x3452, 0x1f },
> > -	{ 0x3453, 0x00 },
> > -	{ 0x3454, 0x17 },
> > -	{ 0x3455, 0x00 },
> > +	{ IMX290_REG_8BIT(0x3405), 0x10 },
> > +	{ IMX290_REG_8BIT(0x3446), 0x57 },
> > +	{ IMX290_REG_8BIT(0x3447), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3448), 0x37 },
> > +	{ IMX290_REG_8BIT(0x3449), 0x00 },
> > +	{ IMX290_REG_8BIT(0x344a), 0x1f },
> > +	{ IMX290_REG_8BIT(0x344b), 0x00 },
> > +	{ IMX290_REG_8BIT(0x344c), 0x1f },
> > +	{ IMX290_REG_8BIT(0x344d), 0x00 },
> > +	{ IMX290_REG_8BIT(0x344e), 0x1f },
> > +	{ IMX290_REG_8BIT(0x344f), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3450), 0x77 },
> > +	{ IMX290_REG_8BIT(0x3451), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3452), 0x1f },
> > +	{ IMX290_REG_8BIT(0x3453), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3454), 0x17 },
> > +	{ IMX290_REG_8BIT(0x3455), 0x00 },
> >  };
> > 
> >  static const struct imx290_regval imx290_720p_settings[] = {
> >  	/* mode settings */
> > -	{ 0x3007, 0x10 },
> > -	{ 0x303a, 0x06 },
> > -	{ 0x3414, 0x04 },
> > -	{ 0x3472, 0x00 },
> > -	{ 0x3473, 0x05 },
> > -	{ 0x3418, 0xd0 },
> > -	{ 0x3419, 0x02 },
> > -	{ 0x3012, 0x64 },
> > -	{ 0x3013, 0x00 },
> > -	{ 0x305c, 0x20 },
> > -	{ 0x305d, 0x00 },
> > -	{ 0x305e, 0x20 },
> > -	{ 0x305f, 0x01 },
> > -	{ 0x315e, 0x1a },
> > -	{ 0x3164, 0x1a },
> > -	{ 0x3480, 0x49 },
> > +	{ IMX290_REG_8BIT(0x3007), 0x10 },
> > +	{ IMX290_REG_8BIT(0x303a), 0x06 },
> > +	{ IMX290_REG_8BIT(0x3414), 0x04 },
> > +	{ IMX290_REG_8BIT(0x3472), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3473), 0x05 },
> > +	{ IMX290_REG_8BIT(0x3418), 0xd0 },
> > +	{ IMX290_REG_8BIT(0x3419), 0x02 },
> > +	{ IMX290_REG_8BIT(0x3012), 0x64 },
> > +	{ IMX290_REG_8BIT(0x3013), 0x00 },
> > +	{ IMX290_REG_8BIT(0x305c), 0x20 },
> > +	{ IMX290_REG_8BIT(0x305d), 0x00 },
> > +	{ IMX290_REG_8BIT(0x305e), 0x20 },
> > +	{ IMX290_REG_8BIT(0x305f), 0x01 },
> > +	{ IMX290_REG_8BIT(0x315e), 0x1a },
> > +	{ IMX290_REG_8BIT(0x3164), 0x1a },
> > +	{ IMX290_REG_8BIT(0x3480), 0x49 },
> >  	/* data rate settings */
> > -	{ 0x3405, 0x10 },
> > -	{ 0x3446, 0x4f },
> > -	{ 0x3447, 0x00 },
> > -	{ 0x3448, 0x2f },
> > -	{ 0x3449, 0x00 },
> > -	{ 0x344a, 0x17 },
> > -	{ 0x344b, 0x00 },
> > -	{ 0x344c, 0x17 },
> > -	{ 0x344d, 0x00 },
> > -	{ 0x344e, 0x17 },
> > -	{ 0x344f, 0x00 },
> > -	{ 0x3450, 0x57 },
> > -	{ 0x3451, 0x00 },
> > -	{ 0x3452, 0x17 },
> > -	{ 0x3453, 0x00 },
> > -	{ 0x3454, 0x17 },
> > -	{ 0x3455, 0x00 },
> > +	{ IMX290_REG_8BIT(0x3405), 0x10 },
> > +	{ IMX290_REG_8BIT(0x3446), 0x4f },
> > +	{ IMX290_REG_8BIT(0x3447), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3448), 0x2f },
> > +	{ IMX290_REG_8BIT(0x3449), 0x00 },
> > +	{ IMX290_REG_8BIT(0x344a), 0x17 },
> > +	{ IMX290_REG_8BIT(0x344b), 0x00 },
> > +	{ IMX290_REG_8BIT(0x344c), 0x17 },
> > +	{ IMX290_REG_8BIT(0x344d), 0x00 },
> > +	{ IMX290_REG_8BIT(0x344e), 0x17 },
> > +	{ IMX290_REG_8BIT(0x344f), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3450), 0x57 },
> > +	{ IMX290_REG_8BIT(0x3451), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3452), 0x17 },
> > +	{ IMX290_REG_8BIT(0x3453), 0x00 },
> > +	{ IMX290_REG_8BIT(0x3454), 0x17 },
> > +	{ IMX290_REG_8BIT(0x3455), 0x00 },
> >  };
> > 
> >  static const struct imx290_regval imx290_10bit_settings[] = {
> > -	{ 0x3005, 0x00},
> > -	{ 0x3046, 0x00},
> > -	{ 0x3129, 0x1d},
> > -	{ 0x317c, 0x12},
> > -	{ 0x31ec, 0x37},
> > -	{ 0x3441, 0x0a},
> > -	{ 0x3442, 0x0a},
> > -	{ 0x300a, 0x3c},
> > -	{ 0x300b, 0x00},
> > +	{ IMX290_REG_8BIT(0x3005), 0x00},
> > +	{ IMX290_REG_8BIT(0x3046), 0x00},
> > +	{ IMX290_REG_8BIT(0x3129), 0x1d},
> > +	{ IMX290_REG_8BIT(0x317c), 0x12},
> > +	{ IMX290_REG_8BIT(0x31ec), 0x37},
> > +	{ IMX290_REG_8BIT(0x3441), 0x0a},
> > +	{ IMX290_REG_8BIT(0x3442), 0x0a},
> > +	{ IMX290_REG_8BIT(0x300a), 0x3c},
> > +	{ IMX290_REG_8BIT(0x300b), 0x00},
> >  };
> > 
> >  static const struct imx290_regval imx290_12bit_settings[] = {
> > -	{ 0x3005, 0x01 },
> > -	{ 0x3046, 0x01 },
> > -	{ 0x3129, 0x00 },
> > -	{ 0x317c, 0x00 },
> > -	{ 0x31ec, 0x0e },
> > -	{ 0x3441, 0x0c },
> > -	{ 0x3442, 0x0c },
> > -	{ 0x300a, 0xf0 },
> > -	{ 0x300b, 0x00 },
> > +	{ IMX290_REG_8BIT(0x3005), 0x01 },
> > +	{ IMX290_REG_8BIT(0x3046), 0x01 },
> > +	{ IMX290_REG_8BIT(0x3129), 0x00 },
> > +	{ IMX290_REG_8BIT(0x317c), 0x00 },
> > +	{ IMX290_REG_8BIT(0x31ec), 0x0e },
> > +	{ IMX290_REG_8BIT(0x3441), 0x0c },
> > +	{ IMX290_REG_8BIT(0x3442), 0x0c },
> > +	{ IMX290_REG_8BIT(0x300a), 0xf0 },
> > +	{ IMX290_REG_8BIT(0x300b), 0x00 },
> >  };
> > 
> >  /* supported link frequencies */
> > @@ -362,33 +368,35 @@ static inline struct imx290 *to_imx290(struct
> > v4l2_subdev *_sd) return container_of(_sd, struct imx290, sd);
> >  }
> > 
> > -static inline int __always_unused imx290_read_reg(struct imx290 *imx290, u16 addr, u8 *value)
> > +static int __always_unused imx290_read_reg(struct imx290 *imx290, u32 addr, u32 *value) {
> > -	unsigned int regval;
> > +	u8 data[3] = { 0, 0, 0 };
> >  	int ret;
> > 
> > -	ret = regmap_read(imx290->regmap, addr, &regval);
> > -	if (ret) {
> > -		dev_err(imx290->dev, "Failed to read register 0x%04x: %d\n",
> > -			addr, ret);
> > +	ret = regmap_raw_read(imx290->regmap, addr & IMX290_REG_ADDR_MASK,
> > +			      data, (addr >> IMX290_REG_SIZE_SHIFT) & 3);
> 
> While I agree with the intention, it fails for some devices, e.g. Vision 
> Components MIPI IMX327 C does not support auto-increment and most probably 
> also valid for the IMX290 model.
> This is similar to the OV9281 variant, see [1].

*sigh* Can't they get their firmware right ? :-( Inserting a
microcontroller between the SoC and sensor is bad enough in itself,
making it mess up I2C access due to firmware bugs is worse.

How far do we need to go in sensor drivers to support messed up hardware
designs that are not related to the sensor at all ? I don't want to
patch all sensor drivers to make I2C read slower because someone
somewhere has taken the sensor and decided to screw up. That doesn't
scale, and hurt all users of these sensors in sane camera modules.

> Reading ID using 16bit register (using later patch) returns:
> > imx290 2-001a: chip ID 0xffd0
> Using 2 8bit reads:
> imx290 2-001a: chip ID 0x07d0
> 
> Best regards,
> Alexander
> 
> [1] https://patchwork.kernel.org/project/linux-media/patch/20220715074858.875808-7-alexander.stein@xxxxxxxxxxxxxxx/
> 
> > +	if (ret < 0) {
> > +		dev_err(imx290->dev, "%u-bit read from 0x%04x failed: %d\n",
> > +			 ((addr >> IMX290_REG_SIZE_SHIFT) & 3) * 8,
> > +			 addr & IMX290_REG_ADDR_MASK, ret);
> >  		return ret;
> >  	}
> > 
> > -	*value = regval & 0xff;
> > -
> > +	*value = (data[2] << 16) | (data[1] << 8) | data[0];
> >  	return 0;
> >  }
> > 
> > -static int imx290_write_reg(struct imx290 *imx290, u16 addr, u8 value)
> > +static int imx290_write_reg(struct imx290 *imx290, u32 addr, u32 value)
> >  {
> > +	u8 data[3] = { value & 0xff, (value >> 8) & 0xff, value >> 16 };
> >  	int ret;
> > 
> > -	ret = regmap_write(imx290->regmap, addr, value);
> > -	if (ret) {
> > -		dev_err(imx290->dev, "Failed to write register 0x%04x: %d\n",
> > -			addr, ret);
> > -		return ret;
> > -	}
> > +	ret = regmap_raw_write(imx290->regmap, addr & IMX290_REG_ADDR_MASK,
> > +			       data, (addr >> IMX290_REG_SIZE_SHIFT) & 3);
> > +	if (ret < 0)
> > +		dev_err(imx290->dev, "%u-bit write to 0x%04x failed: %d\n",
> > +			 ((addr >> IMX290_REG_SIZE_SHIFT) & 3) * 8,
> > +			 addr & IMX290_REG_ADDR_MASK, ret);
> > 
> >  	return ret;
> >  }

-- 
Regards,

Laurent Pinchart



[Index of Archives]     [Linux Input]     [Video for Linux]     [Gstreamer Embedded]     [Mplayer Users]     [Linux USB Devel]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [Yosemite Backpacking]

  Powered by Linux