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, ®val); > > - 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