| Message ID | 20181101041534.5913-3-matt.ranostay@konsulko.com (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
| Series | media: video-i2c: add Melexis MLX90640 thermal camera support | expand |
On 11/01/2018 05:15 AM, Matt Ranostay wrote: > Add initial support for MLX90640 thermal cameras which output an 32x24 > greyscale pixel image along with 2 rows of coefficent data. > > Because of this the data outputed is really 32x26 and needs the two rows > removed after using the coefficent information to generate processed > images in userspace. > > Signed-off-by: Matt Ranostay <matt.ranostay@konsulko.com> > --- > drivers/media/i2c/Kconfig | 1 + > drivers/media/i2c/video-i2c.c | 110 +++++++++++++++++++++++++++++++++- > 2 files changed, 110 insertions(+), 1 deletion(-) > > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig > index 704af210e270..4bfb2c66d192 100644 > --- a/drivers/media/i2c/Kconfig > +++ b/drivers/media/i2c/Kconfig > @@ -1085,6 +1085,7 @@ config VIDEO_I2C > Enable the I2C transport video support which supports the > following: > * Panasonic AMG88xx Grid-Eye Sensors > + * Melexis MLX90640 Thermal Cameras > > To compile this driver as a module, choose M here: the > module will be called video-i2c > diff --git a/drivers/media/i2c/video-i2c.c b/drivers/media/i2c/video-i2c.c > index 6d3b6df0b634..38ade8cb7656 100644 > --- a/drivers/media/i2c/video-i2c.c > +++ b/drivers/media/i2c/video-i2c.c > @@ -6,6 +6,7 @@ > * > * Supported: > * - Panasonic AMG88xx Grid-Eye Sensors > + * - Melexis MLX90640 Thermal Cameras > */ > > #include <linux/delay.h> > @@ -18,6 +19,7 @@ > #include <linux/mutex.h> > #include <linux/of_device.h> > #include <linux/pm_runtime.h> > +#include <linux/nvmem-provider.h> > #include <linux/regmap.h> > #include <linux/sched.h> > #include <linux/slab.h> > @@ -66,12 +68,26 @@ static const struct v4l2_frmsize_discrete amg88xx_size = { > .height = 8, > }; > > +static const struct v4l2_fmtdesc mlx90640_format = { > + .pixelformat = V4L2_PIX_FMT_Y16_BE, > +}; > + > +static const struct v4l2_frmsize_discrete mlx90640_size = { > + .width = 32, > + .height = 26, /* 24 lines of pixel data + 2 lines of processing data */ > +}; > + > static const struct regmap_config amg88xx_regmap_config = { > .reg_bits = 8, > .val_bits = 8, > .max_register = 0xff > }; > > +static const struct regmap_config mlx90640_regmap_config = { > + .reg_bits = 16, > + .val_bits = 16, > +}; > + > struct video_i2c_chip { > /* video dimensions */ > const struct v4l2_fmtdesc *format; > @@ -88,6 +104,7 @@ struct video_i2c_chip { > unsigned int bpp; > > const struct regmap_config *regmap_config; > + struct nvmem_config *nvmem_config; > > /* setup function */ > int (*setup)(struct video_i2c_data *data); > @@ -102,6 +119,22 @@ struct video_i2c_chip { > int (*hwmon_init)(struct video_i2c_data *data); > }; > > +static int mlx90640_nvram_read(void *priv, unsigned int offset, void *val, > + size_t bytes) > +{ > + struct video_i2c_data *data = priv; > + > + return regmap_bulk_read(data->regmap, 0x2400 + offset, val, bytes); > +} > + > +static struct nvmem_config mlx90640_nvram_config = { > + .name = "mlx90640_nvram", > + .word_size = 2, > + .stride = 1, > + .size = 1664, > + .reg_read = mlx90640_nvram_read, > +}; > + > /* Power control register */ > #define AMG88XX_REG_PCTL 0x00 > #define AMG88XX_PCTL_NORMAL 0x00 > @@ -122,12 +155,23 @@ struct video_i2c_chip { > /* Temperature register */ > #define AMG88XX_REG_T01L 0x80 > > +/* Control register */ > +#define MLX90640_REG_CTL1 0x800d > +#define MLX90640_REG_CTL1_MASK 0x0380 > +#define MLX90640_REG_CTL1_MASK_SHIFT 7 > + > static int amg88xx_xfer(struct video_i2c_data *data, char *buf) > { > return regmap_bulk_read(data->regmap, AMG88XX_REG_T01L, buf, > data->chip->buffer_size); > } > > +static int mlx90640_xfer(struct video_i2c_data *data, char *buf) > +{ > + return regmap_bulk_read(data->regmap, 0x400, buf, > + data->chip->buffer_size); > +} > + > static int amg88xx_setup(struct video_i2c_data *data) > { > unsigned int mask = AMG88XX_FPSC_1FPS; > @@ -141,6 +185,27 @@ static int amg88xx_setup(struct video_i2c_data *data) > return regmap_update_bits(data->regmap, AMG88XX_REG_FPSC, mask, val); > } > > +static int mlx90640_setup(struct video_i2c_data *data) > +{ > + unsigned int n, idx; > + > + for (n = 0; n < data->chip->num_frame_intervals - 1; n++) { > + if (data->frame_interval.numerator > + != data->chip->frame_intervals[n].numerator) > + continue; > + > + if (data->frame_interval.denominator > + == data->chip->frame_intervals[n].denominator) > + break; > + } > + > + idx = data->chip->num_frame_intervals - n - 1; > + > + return regmap_update_bits(data->regmap, MLX90640_REG_CTL1, > + MLX90640_REG_CTL1_MASK, > + idx << MLX90640_REG_CTL1_MASK_SHIFT); > +} > + > static int amg88xx_set_power_on(struct video_i2c_data *data) > { > int ret; > @@ -274,13 +339,27 @@ static int amg88xx_hwmon_init(struct video_i2c_data *data) > #define amg88xx_hwmon_init NULL > #endif > > -#define AMG88XX 0 > +enum { > + AMG88XX, > + MLX90640, > +}; > > static const struct v4l2_fract amg88xx_frame_intervals[] = { > { 1, 10 }, > { 1, 1 }, > }; > > +static const struct v4l2_fract mlx90640_frame_intervals[] = { > + { 1, 64 }, > + { 1, 32 }, > + { 1, 16 }, > + { 1, 8 }, > + { 1, 4 }, > + { 1, 2 }, > + { 1, 1 }, > + { 2, 1 }, > +}; > + > static const struct video_i2c_chip video_i2c_chip[] = { > [AMG88XX] = { > .size = &amg88xx_size, > @@ -295,6 +374,18 @@ static const struct video_i2c_chip video_i2c_chip[] = { > .set_power = amg88xx_set_power, > .hwmon_init = amg88xx_hwmon_init, > }, > + [MLX90640] = { > + .size = &mlx90640_size, > + .format = &mlx90640_format, > + .frame_intervals = mlx90640_frame_intervals, > + .num_frame_intervals = ARRAY_SIZE(mlx90640_frame_intervals), > + .buffer_size = 1664, > + .bpp = 16, > + .regmap_config = &mlx90640_regmap_config, > + .nvmem_config = &mlx90640_nvram_config, > + .setup = mlx90640_setup, > + .xfer = mlx90640_xfer, > + }, > }; > > static const struct v4l2_file_operations video_i2c_fops = { > @@ -756,6 +847,21 @@ static int video_i2c_probe(struct i2c_client *client, > } > } > > + if (data->chip->nvmem_config) { > + struct nvmem_config *config = data->chip->nvmem_config; > + struct nvmem_device *device; > + > + config->priv = data; > + config->dev = &client->dev; > + > + device = devm_nvmem_register(&client->dev, config); > + > + if (IS_ERR(device)) { > + dev_warn(&client->dev, > + "failed to register nvmem device\n"); > + } > + } > + > ret = video_register_device(&data->vdev, VFL_TYPE_GRABBER, -1); > if (ret < 0) > goto error_pm_disable; > @@ -834,12 +940,14 @@ static const struct dev_pm_ops video_i2c_pm_ops = { > > static const struct i2c_device_id video_i2c_id_table[] = { > { "amg88xx", AMG88XX }, > + { "mlx90640", MLX90640 }, > {} > }; > MODULE_DEVICE_TABLE(i2c, video_i2c_id_table); > > static const struct of_device_id video_i2c_of_match[] = { > { .compatible = "panasonic,amg88xx", .data = &video_i2c_chip[AMG88XX] }, > + { .compatible = "melexis,mlx90640", .data = &video_i2c_chip[MLX90640] }, Missing documentation for melexis,mlx90640 in bindings: WARNING: DT compatible string "melexis,mlx90640" appears un-documented -- check ./Documentation/devicetree/bindings/ Regards, Hans > {} > }; > MODULE_DEVICE_TABLE(of, video_i2c_of_match); >
On Mon, Nov 19, 2018 at 6:26 AM Hans Verkuil <hverkuil@xs4all.nl> wrote: > > On 11/01/2018 05:15 AM, Matt Ranostay wrote: > > Add initial support for MLX90640 thermal cameras which output an 32x24 > > greyscale pixel image along with 2 rows of coefficent data. > > > > Because of this the data outputed is really 32x26 and needs the two rows > > removed after using the coefficent information to generate processed > > images in userspace. > > > > Signed-off-by: Matt Ranostay <matt.ranostay@konsulko.com> > > --- > > drivers/media/i2c/Kconfig | 1 + > > drivers/media/i2c/video-i2c.c | 110 +++++++++++++++++++++++++++++++++- > > 2 files changed, 110 insertions(+), 1 deletion(-) > > > > > > > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig > > index 704af210e270..4bfb2c66d192 100644 > > --- a/drivers/media/i2c/Kconfig > > +++ b/drivers/media/i2c/Kconfig > > @@ -1085,6 +1085,7 @@ config VIDEO_I2C > > Enable the I2C transport video support which supports the > > following: > > * Panasonic AMG88xx Grid-Eye Sensors > > + * Melexis MLX90640 Thermal Cameras > > > > To compile this driver as a module, choose M here: the > > module will be called video-i2c > > diff --git a/drivers/media/i2c/video-i2c.c b/drivers/media/i2c/video-i2c.c > > index 6d3b6df0b634..38ade8cb7656 100644 > > --- a/drivers/media/i2c/video-i2c.c > > +++ b/drivers/media/i2c/video-i2c.c > > @@ -6,6 +6,7 @@ > > * > > * Supported: > > * - Panasonic AMG88xx Grid-Eye Sensors > > + * - Melexis MLX90640 Thermal Cameras > > */ > > > > #include <linux/delay.h> > > @@ -18,6 +19,7 @@ > > #include <linux/mutex.h> > > #include <linux/of_device.h> > > #include <linux/pm_runtime.h> > > +#include <linux/nvmem-provider.h> > > #include <linux/regmap.h> > > #include <linux/sched.h> > > #include <linux/slab.h> > > @@ -66,12 +68,26 @@ static const struct v4l2_frmsize_discrete amg88xx_size = { > > .height = 8, > > }; > > > > +static const struct v4l2_fmtdesc mlx90640_format = { > > + .pixelformat = V4L2_PIX_FMT_Y16_BE, > > +}; > > + > > +static const struct v4l2_frmsize_discrete mlx90640_size = { > > + .width = 32, > > + .height = 26, /* 24 lines of pixel data + 2 lines of processing data */ > > +}; > > + > > static const struct regmap_config amg88xx_regmap_config = { > > .reg_bits = 8, > > .val_bits = 8, > > .max_register = 0xff > > }; > > > > +static const struct regmap_config mlx90640_regmap_config = { > > + .reg_bits = 16, > > + .val_bits = 16, > > +}; > > + > > struct video_i2c_chip { > > /* video dimensions */ > > const struct v4l2_fmtdesc *format; > > @@ -88,6 +104,7 @@ struct video_i2c_chip { > > unsigned int bpp; > > > > const struct regmap_config *regmap_config; > > + struct nvmem_config *nvmem_config; > > > > /* setup function */ > > int (*setup)(struct video_i2c_data *data); > > @@ -102,6 +119,22 @@ struct video_i2c_chip { > > int (*hwmon_init)(struct video_i2c_data *data); > > }; > > > > +static int mlx90640_nvram_read(void *priv, unsigned int offset, void *val, > > + size_t bytes) > > +{ > > + struct video_i2c_data *data = priv; > > + > > + return regmap_bulk_read(data->regmap, 0x2400 + offset, val, bytes); > > +} > > + > > +static struct nvmem_config mlx90640_nvram_config = { > > + .name = "mlx90640_nvram", > > + .word_size = 2, > > + .stride = 1, > > + .size = 1664, > > + .reg_read = mlx90640_nvram_read, > > +}; > > + > > /* Power control register */ > > #define AMG88XX_REG_PCTL 0x00 > > #define AMG88XX_PCTL_NORMAL 0x00 > > @@ -122,12 +155,23 @@ struct video_i2c_chip { > > /* Temperature register */ > > #define AMG88XX_REG_T01L 0x80 > > > > +/* Control register */ > > +#define MLX90640_REG_CTL1 0x800d > > +#define MLX90640_REG_CTL1_MASK 0x0380 > > +#define MLX90640_REG_CTL1_MASK_SHIFT 7 > > + > > static int amg88xx_xfer(struct video_i2c_data *data, char *buf) > > { > > return regmap_bulk_read(data->regmap, AMG88XX_REG_T01L, buf, > > data->chip->buffer_size); > > } > > > > +static int mlx90640_xfer(struct video_i2c_data *data, char *buf) > > +{ > > + return regmap_bulk_read(data->regmap, 0x400, buf, > > + data->chip->buffer_size); > > +} > > + > > static int amg88xx_setup(struct video_i2c_data *data) > > { > > unsigned int mask = AMG88XX_FPSC_1FPS; > > @@ -141,6 +185,27 @@ static int amg88xx_setup(struct video_i2c_data *data) > > return regmap_update_bits(data->regmap, AMG88XX_REG_FPSC, mask, val); > > } > > > > +static int mlx90640_setup(struct video_i2c_data *data) > > +{ > > + unsigned int n, idx; > > + > > + for (n = 0; n < data->chip->num_frame_intervals - 1; n++) { > > + if (data->frame_interval.numerator > > + != data->chip->frame_intervals[n].numerator) > > + continue; > > + > > + if (data->frame_interval.denominator > > + == data->chip->frame_intervals[n].denominator) > > + break; > > + } > > + > > + idx = data->chip->num_frame_intervals - n - 1; > > + > > + return regmap_update_bits(data->regmap, MLX90640_REG_CTL1, > > + MLX90640_REG_CTL1_MASK, > > + idx << MLX90640_REG_CTL1_MASK_SHIFT); > > +} > > + > > static int amg88xx_set_power_on(struct video_i2c_data *data) > > { > > int ret; > > @@ -274,13 +339,27 @@ static int amg88xx_hwmon_init(struct video_i2c_data *data) > > #define amg88xx_hwmon_init NULL > > #endif > > > > -#define AMG88XX 0 > > +enum { > > + AMG88XX, > > + MLX90640, > > +}; > > > > static const struct v4l2_fract amg88xx_frame_intervals[] = { > > { 1, 10 }, > > { 1, 1 }, > > }; > > > > +static const struct v4l2_fract mlx90640_frame_intervals[] = { > > + { 1, 64 }, > > + { 1, 32 }, > > + { 1, 16 }, > > + { 1, 8 }, > > + { 1, 4 }, > > + { 1, 2 }, > > + { 1, 1 }, > > + { 2, 1 }, > > +}; > > + > > static const struct video_i2c_chip video_i2c_chip[] = { > > [AMG88XX] = { > > .size = &amg88xx_size, > > @@ -295,6 +374,18 @@ static const struct video_i2c_chip video_i2c_chip[] = { > > .set_power = amg88xx_set_power, > > .hwmon_init = amg88xx_hwmon_init, > > }, > > + [MLX90640] = { > > + .size = &mlx90640_size, > > + .format = &mlx90640_format, > > + .frame_intervals = mlx90640_frame_intervals, > > + .num_frame_intervals = ARRAY_SIZE(mlx90640_frame_intervals), > > + .buffer_size = 1664, > > + .bpp = 16, > > + .regmap_config = &mlx90640_regmap_config, > > + .nvmem_config = &mlx90640_nvram_config, > > + .setup = mlx90640_setup, > > + .xfer = mlx90640_xfer, > > + }, > > }; > > > > static const struct v4l2_file_operations video_i2c_fops = { > > @@ -756,6 +847,21 @@ static int video_i2c_probe(struct i2c_client *client, > > } > > } > > > > + if (data->chip->nvmem_config) { > > + struct nvmem_config *config = data->chip->nvmem_config; > > + struct nvmem_device *device; > > + > > + config->priv = data; > > + config->dev = &client->dev; > > + > > + device = devm_nvmem_register(&client->dev, config); > > + > > + if (IS_ERR(device)) { > > + dev_warn(&client->dev, > > + "failed to register nvmem device\n"); > > + } > > + } > > + > > ret = video_register_device(&data->vdev, VFL_TYPE_GRABBER, -1); > > if (ret < 0) > > goto error_pm_disable; > > @@ -834,12 +940,14 @@ static const struct dev_pm_ops video_i2c_pm_ops = { > > > > static const struct i2c_device_id video_i2c_id_table[] = { > > { "amg88xx", AMG88XX }, > > + { "mlx90640", MLX90640 }, > > {} > > }; > > MODULE_DEVICE_TABLE(i2c, video_i2c_id_table); > > > > static const struct of_device_id video_i2c_of_match[] = { > > { .compatible = "panasonic,amg88xx", .data = &video_i2c_chip[AMG88XX] }, > > + { .compatible = "melexis,mlx90640", .data = &video_i2c_chip[MLX90640] }, > > Missing documentation for melexis,mlx90640 in bindings: > > WARNING: DT compatible string "melexis,mlx90640" appears un-documented -- check ./Documentation/devicetree/bindings/ > Hmm we don't currently have a device tree documentation for this driver, should there one be created (e.g. video-i2c.rst)? - Matt > Regards, > > Hans > > > {} > > }; > > MODULE_DEVICE_TABLE(of, video_i2c_of_match); > > >
On 11/19/2018 09:54 PM, Matt Ranostay wrote: > On Mon, Nov 19, 2018 at 6:26 AM Hans Verkuil <hverkuil@xs4all.nl> wrote: >> >> On 11/01/2018 05:15 AM, Matt Ranostay wrote: >>> Add initial support for MLX90640 thermal cameras which output an 32x24 >>> greyscale pixel image along with 2 rows of coefficent data. >>> >>> Because of this the data outputed is really 32x26 and needs the two rows >>> removed after using the coefficent information to generate processed >>> images in userspace. >>> >>> Signed-off-by: Matt Ranostay <matt.ranostay@konsulko.com> >>> --- >>> drivers/media/i2c/Kconfig | 1 + >>> drivers/media/i2c/video-i2c.c | 110 +++++++++++++++++++++++++++++++++- >>> 2 files changed, 110 insertions(+), 1 deletion(-) >> >> >> >>> >>> diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig >>> index 704af210e270..4bfb2c66d192 100644 >>> --- a/drivers/media/i2c/Kconfig >>> +++ b/drivers/media/i2c/Kconfig >>> @@ -1085,6 +1085,7 @@ config VIDEO_I2C >>> Enable the I2C transport video support which supports the >>> following: >>> * Panasonic AMG88xx Grid-Eye Sensors >>> + * Melexis MLX90640 Thermal Cameras >>> >>> To compile this driver as a module, choose M here: the >>> module will be called video-i2c >>> diff --git a/drivers/media/i2c/video-i2c.c b/drivers/media/i2c/video-i2c.c >>> index 6d3b6df0b634..38ade8cb7656 100644 >>> --- a/drivers/media/i2c/video-i2c.c >>> +++ b/drivers/media/i2c/video-i2c.c >>> @@ -6,6 +6,7 @@ >>> * >>> * Supported: >>> * - Panasonic AMG88xx Grid-Eye Sensors >>> + * - Melexis MLX90640 Thermal Cameras >>> */ >>> >>> #include <linux/delay.h> >>> @@ -18,6 +19,7 @@ >>> #include <linux/mutex.h> >>> #include <linux/of_device.h> >>> #include <linux/pm_runtime.h> >>> +#include <linux/nvmem-provider.h> >>> #include <linux/regmap.h> >>> #include <linux/sched.h> >>> #include <linux/slab.h> >>> @@ -66,12 +68,26 @@ static const struct v4l2_frmsize_discrete amg88xx_size = { >>> .height = 8, >>> }; >>> >>> +static const struct v4l2_fmtdesc mlx90640_format = { >>> + .pixelformat = V4L2_PIX_FMT_Y16_BE, >>> +}; >>> + >>> +static const struct v4l2_frmsize_discrete mlx90640_size = { >>> + .width = 32, >>> + .height = 26, /* 24 lines of pixel data + 2 lines of processing data */ >>> +}; >>> + >>> static const struct regmap_config amg88xx_regmap_config = { >>> .reg_bits = 8, >>> .val_bits = 8, >>> .max_register = 0xff >>> }; >>> >>> +static const struct regmap_config mlx90640_regmap_config = { >>> + .reg_bits = 16, >>> + .val_bits = 16, >>> +}; >>> + >>> struct video_i2c_chip { >>> /* video dimensions */ >>> const struct v4l2_fmtdesc *format; >>> @@ -88,6 +104,7 @@ struct video_i2c_chip { >>> unsigned int bpp; >>> >>> const struct regmap_config *regmap_config; >>> + struct nvmem_config *nvmem_config; >>> >>> /* setup function */ >>> int (*setup)(struct video_i2c_data *data); >>> @@ -102,6 +119,22 @@ struct video_i2c_chip { >>> int (*hwmon_init)(struct video_i2c_data *data); >>> }; >>> >>> +static int mlx90640_nvram_read(void *priv, unsigned int offset, void *val, >>> + size_t bytes) >>> +{ >>> + struct video_i2c_data *data = priv; >>> + >>> + return regmap_bulk_read(data->regmap, 0x2400 + offset, val, bytes); >>> +} >>> + >>> +static struct nvmem_config mlx90640_nvram_config = { >>> + .name = "mlx90640_nvram", >>> + .word_size = 2, >>> + .stride = 1, >>> + .size = 1664, >>> + .reg_read = mlx90640_nvram_read, >>> +}; >>> + >>> /* Power control register */ >>> #define AMG88XX_REG_PCTL 0x00 >>> #define AMG88XX_PCTL_NORMAL 0x00 >>> @@ -122,12 +155,23 @@ struct video_i2c_chip { >>> /* Temperature register */ >>> #define AMG88XX_REG_T01L 0x80 >>> >>> +/* Control register */ >>> +#define MLX90640_REG_CTL1 0x800d >>> +#define MLX90640_REG_CTL1_MASK 0x0380 >>> +#define MLX90640_REG_CTL1_MASK_SHIFT 7 >>> + >>> static int amg88xx_xfer(struct video_i2c_data *data, char *buf) >>> { >>> return regmap_bulk_read(data->regmap, AMG88XX_REG_T01L, buf, >>> data->chip->buffer_size); >>> } >>> >>> +static int mlx90640_xfer(struct video_i2c_data *data, char *buf) >>> +{ >>> + return regmap_bulk_read(data->regmap, 0x400, buf, >>> + data->chip->buffer_size); >>> +} >>> + >>> static int amg88xx_setup(struct video_i2c_data *data) >>> { >>> unsigned int mask = AMG88XX_FPSC_1FPS; >>> @@ -141,6 +185,27 @@ static int amg88xx_setup(struct video_i2c_data *data) >>> return regmap_update_bits(data->regmap, AMG88XX_REG_FPSC, mask, val); >>> } >>> >>> +static int mlx90640_setup(struct video_i2c_data *data) >>> +{ >>> + unsigned int n, idx; >>> + >>> + for (n = 0; n < data->chip->num_frame_intervals - 1; n++) { >>> + if (data->frame_interval.numerator >>> + != data->chip->frame_intervals[n].numerator) >>> + continue; >>> + >>> + if (data->frame_interval.denominator >>> + == data->chip->frame_intervals[n].denominator) >>> + break; >>> + } >>> + >>> + idx = data->chip->num_frame_intervals - n - 1; >>> + >>> + return regmap_update_bits(data->regmap, MLX90640_REG_CTL1, >>> + MLX90640_REG_CTL1_MASK, >>> + idx << MLX90640_REG_CTL1_MASK_SHIFT); >>> +} >>> + >>> static int amg88xx_set_power_on(struct video_i2c_data *data) >>> { >>> int ret; >>> @@ -274,13 +339,27 @@ static int amg88xx_hwmon_init(struct video_i2c_data *data) >>> #define amg88xx_hwmon_init NULL >>> #endif >>> >>> -#define AMG88XX 0 >>> +enum { >>> + AMG88XX, >>> + MLX90640, >>> +}; >>> >>> static const struct v4l2_fract amg88xx_frame_intervals[] = { >>> { 1, 10 }, >>> { 1, 1 }, >>> }; >>> >>> +static const struct v4l2_fract mlx90640_frame_intervals[] = { >>> + { 1, 64 }, >>> + { 1, 32 }, >>> + { 1, 16 }, >>> + { 1, 8 }, >>> + { 1, 4 }, >>> + { 1, 2 }, >>> + { 1, 1 }, >>> + { 2, 1 }, >>> +}; >>> + >>> static const struct video_i2c_chip video_i2c_chip[] = { >>> [AMG88XX] = { >>> .size = &amg88xx_size, >>> @@ -295,6 +374,18 @@ static const struct video_i2c_chip video_i2c_chip[] = { >>> .set_power = amg88xx_set_power, >>> .hwmon_init = amg88xx_hwmon_init, >>> }, >>> + [MLX90640] = { >>> + .size = &mlx90640_size, >>> + .format = &mlx90640_format, >>> + .frame_intervals = mlx90640_frame_intervals, >>> + .num_frame_intervals = ARRAY_SIZE(mlx90640_frame_intervals), >>> + .buffer_size = 1664, >>> + .bpp = 16, >>> + .regmap_config = &mlx90640_regmap_config, >>> + .nvmem_config = &mlx90640_nvram_config, >>> + .setup = mlx90640_setup, >>> + .xfer = mlx90640_xfer, >>> + }, >>> }; >>> >>> static const struct v4l2_file_operations video_i2c_fops = { >>> @@ -756,6 +847,21 @@ static int video_i2c_probe(struct i2c_client *client, >>> } >>> } >>> >>> + if (data->chip->nvmem_config) { >>> + struct nvmem_config *config = data->chip->nvmem_config; >>> + struct nvmem_device *device; >>> + >>> + config->priv = data; >>> + config->dev = &client->dev; >>> + >>> + device = devm_nvmem_register(&client->dev, config); >>> + >>> + if (IS_ERR(device)) { >>> + dev_warn(&client->dev, >>> + "failed to register nvmem device\n"); >>> + } >>> + } >>> + >>> ret = video_register_device(&data->vdev, VFL_TYPE_GRABBER, -1); >>> if (ret < 0) >>> goto error_pm_disable; >>> @@ -834,12 +940,14 @@ static const struct dev_pm_ops video_i2c_pm_ops = { >>> >>> static const struct i2c_device_id video_i2c_id_table[] = { >>> { "amg88xx", AMG88XX }, >>> + { "mlx90640", MLX90640 }, >>> {} >>> }; >>> MODULE_DEVICE_TABLE(i2c, video_i2c_id_table); >>> >>> static const struct of_device_id video_i2c_of_match[] = { >>> { .compatible = "panasonic,amg88xx", .data = &video_i2c_chip[AMG88XX] }, >>> + { .compatible = "melexis,mlx90640", .data = &video_i2c_chip[MLX90640] }, >> >> Missing documentation for melexis,mlx90640 in bindings: >> >> WARNING: DT compatible string "melexis,mlx90640" appears un-documented -- check ./Documentation/devicetree/bindings/ >> > > Hmm we don't currently have a device tree documentation for this > driver, should there one be created (e.g. video-i2c.rst)? There is already a file for panasonic,amg88xx, but perhaps that should be renamed to video-i2c.rst and melexis,mlx90640 should be added to it? Either that, or add a new melexis,mlx90640.txt next to Documentation/devicetree/bindings/media/i2c/panasonic,amg88xx.txt. Regards, Hans
diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig index 704af210e270..4bfb2c66d192 100644 --- a/drivers/media/i2c/Kconfig +++ b/drivers/media/i2c/Kconfig @@ -1085,6 +1085,7 @@ config VIDEO_I2C Enable the I2C transport video support which supports the following: * Panasonic AMG88xx Grid-Eye Sensors + * Melexis MLX90640 Thermal Cameras To compile this driver as a module, choose M here: the module will be called video-i2c diff --git a/drivers/media/i2c/video-i2c.c b/drivers/media/i2c/video-i2c.c index 6d3b6df0b634..38ade8cb7656 100644 --- a/drivers/media/i2c/video-i2c.c +++ b/drivers/media/i2c/video-i2c.c @@ -6,6 +6,7 @@ * * Supported: * - Panasonic AMG88xx Grid-Eye Sensors + * - Melexis MLX90640 Thermal Cameras */ #include <linux/delay.h> @@ -18,6 +19,7 @@ #include <linux/mutex.h> #include <linux/of_device.h> #include <linux/pm_runtime.h> +#include <linux/nvmem-provider.h> #include <linux/regmap.h> #include <linux/sched.h> #include <linux/slab.h> @@ -66,12 +68,26 @@ static const struct v4l2_frmsize_discrete amg88xx_size = { .height = 8, }; +static const struct v4l2_fmtdesc mlx90640_format = { + .pixelformat = V4L2_PIX_FMT_Y16_BE, +}; + +static const struct v4l2_frmsize_discrete mlx90640_size = { + .width = 32, + .height = 26, /* 24 lines of pixel data + 2 lines of processing data */ +}; + static const struct regmap_config amg88xx_regmap_config = { .reg_bits = 8, .val_bits = 8, .max_register = 0xff }; +static const struct regmap_config mlx90640_regmap_config = { + .reg_bits = 16, + .val_bits = 16, +}; + struct video_i2c_chip { /* video dimensions */ const struct v4l2_fmtdesc *format; @@ -88,6 +104,7 @@ struct video_i2c_chip { unsigned int bpp; const struct regmap_config *regmap_config; + struct nvmem_config *nvmem_config; /* setup function */ int (*setup)(struct video_i2c_data *data); @@ -102,6 +119,22 @@ struct video_i2c_chip { int (*hwmon_init)(struct video_i2c_data *data); }; +static int mlx90640_nvram_read(void *priv, unsigned int offset, void *val, + size_t bytes) +{ + struct video_i2c_data *data = priv; + + return regmap_bulk_read(data->regmap, 0x2400 + offset, val, bytes); +} + +static struct nvmem_config mlx90640_nvram_config = { + .name = "mlx90640_nvram", + .word_size = 2, + .stride = 1, + .size = 1664, + .reg_read = mlx90640_nvram_read, +}; + /* Power control register */ #define AMG88XX_REG_PCTL 0x00 #define AMG88XX_PCTL_NORMAL 0x00 @@ -122,12 +155,23 @@ struct video_i2c_chip { /* Temperature register */ #define AMG88XX_REG_T01L 0x80 +/* Control register */ +#define MLX90640_REG_CTL1 0x800d +#define MLX90640_REG_CTL1_MASK 0x0380 +#define MLX90640_REG_CTL1_MASK_SHIFT 7 + static int amg88xx_xfer(struct video_i2c_data *data, char *buf) { return regmap_bulk_read(data->regmap, AMG88XX_REG_T01L, buf, data->chip->buffer_size); } +static int mlx90640_xfer(struct video_i2c_data *data, char *buf) +{ + return regmap_bulk_read(data->regmap, 0x400, buf, + data->chip->buffer_size); +} + static int amg88xx_setup(struct video_i2c_data *data) { unsigned int mask = AMG88XX_FPSC_1FPS; @@ -141,6 +185,27 @@ static int amg88xx_setup(struct video_i2c_data *data) return regmap_update_bits(data->regmap, AMG88XX_REG_FPSC, mask, val); } +static int mlx90640_setup(struct video_i2c_data *data) +{ + unsigned int n, idx; + + for (n = 0; n < data->chip->num_frame_intervals - 1; n++) { + if (data->frame_interval.numerator + != data->chip->frame_intervals[n].numerator) + continue; + + if (data->frame_interval.denominator + == data->chip->frame_intervals[n].denominator) + break; + } + + idx = data->chip->num_frame_intervals - n - 1; + + return regmap_update_bits(data->regmap, MLX90640_REG_CTL1, + MLX90640_REG_CTL1_MASK, + idx << MLX90640_REG_CTL1_MASK_SHIFT); +} + static int amg88xx_set_power_on(struct video_i2c_data *data) { int ret; @@ -274,13 +339,27 @@ static int amg88xx_hwmon_init(struct video_i2c_data *data) #define amg88xx_hwmon_init NULL #endif -#define AMG88XX 0 +enum { + AMG88XX, + MLX90640, +}; static const struct v4l2_fract amg88xx_frame_intervals[] = { { 1, 10 }, { 1, 1 }, }; +static const struct v4l2_fract mlx90640_frame_intervals[] = { + { 1, 64 }, + { 1, 32 }, + { 1, 16 }, + { 1, 8 }, + { 1, 4 }, + { 1, 2 }, + { 1, 1 }, + { 2, 1 }, +}; + static const struct video_i2c_chip video_i2c_chip[] = { [AMG88XX] = { .size = &amg88xx_size, @@ -295,6 +374,18 @@ static const struct video_i2c_chip video_i2c_chip[] = { .set_power = amg88xx_set_power, .hwmon_init = amg88xx_hwmon_init, }, + [MLX90640] = { + .size = &mlx90640_size, + .format = &mlx90640_format, + .frame_intervals = mlx90640_frame_intervals, + .num_frame_intervals = ARRAY_SIZE(mlx90640_frame_intervals), + .buffer_size = 1664, + .bpp = 16, + .regmap_config = &mlx90640_regmap_config, + .nvmem_config = &mlx90640_nvram_config, + .setup = mlx90640_setup, + .xfer = mlx90640_xfer, + }, }; static const struct v4l2_file_operations video_i2c_fops = { @@ -756,6 +847,21 @@ static int video_i2c_probe(struct i2c_client *client, } } + if (data->chip->nvmem_config) { + struct nvmem_config *config = data->chip->nvmem_config; + struct nvmem_device *device; + + config->priv = data; + config->dev = &client->dev; + + device = devm_nvmem_register(&client->dev, config); + + if (IS_ERR(device)) { + dev_warn(&client->dev, + "failed to register nvmem device\n"); + } + } + ret = video_register_device(&data->vdev, VFL_TYPE_GRABBER, -1); if (ret < 0) goto error_pm_disable; @@ -834,12 +940,14 @@ static const struct dev_pm_ops video_i2c_pm_ops = { static const struct i2c_device_id video_i2c_id_table[] = { { "amg88xx", AMG88XX }, + { "mlx90640", MLX90640 }, {} }; MODULE_DEVICE_TABLE(i2c, video_i2c_id_table); static const struct of_device_id video_i2c_of_match[] = { { .compatible = "panasonic,amg88xx", .data = &video_i2c_chip[AMG88XX] }, + { .compatible = "melexis,mlx90640", .data = &video_i2c_chip[MLX90640] }, {} }; MODULE_DEVICE_TABLE(of, video_i2c_of_match);
Add initial support for MLX90640 thermal cameras which output an 32x24 greyscale pixel image along with 2 rows of coefficent data. Because of this the data outputed is really 32x26 and needs the two rows removed after using the coefficent information to generate processed images in userspace. Signed-off-by: Matt Ranostay <matt.ranostay@konsulko.com> --- drivers/media/i2c/Kconfig | 1 + drivers/media/i2c/video-i2c.c | 110 +++++++++++++++++++++++++++++++++- 2 files changed, 110 insertions(+), 1 deletion(-)