[media] mt9v032: Add support for monochrome models
Identify the model based on the I2C device name and configure formats accordingly. Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Signed-off-by: Mauro Carvalho Chehab <m.chehab@samsung.com>
This commit is contained in:
parent
637f005e45
commit
220ddc7f1d
|
@ -121,6 +121,24 @@
|
|||
#define MT9V032_AGC_ENABLE (1 << 1)
|
||||
#define MT9V032_THERMAL_INFO 0xc1
|
||||
|
||||
enum mt9v032_model {
|
||||
MT9V032_MODEL_COLOR,
|
||||
MT9V032_MODEL_MONO,
|
||||
};
|
||||
|
||||
struct mt9v032_model_info {
|
||||
bool color;
|
||||
};
|
||||
|
||||
static const struct mt9v032_model_info mt9v032_models[] = {
|
||||
[MT9V032_MODEL_COLOR] = {
|
||||
.color = true,
|
||||
},
|
||||
[MT9V032_MODEL_MONO] = {
|
||||
.color = false,
|
||||
},
|
||||
};
|
||||
|
||||
struct mt9v032 {
|
||||
struct v4l2_subdev subdev;
|
||||
struct media_pad pad;
|
||||
|
@ -142,6 +160,7 @@ struct mt9v032 {
|
|||
struct clk *clk;
|
||||
|
||||
struct mt9v032_platform_data *pdata;
|
||||
const struct mt9v032_model_info *model;
|
||||
|
||||
u32 sysclk;
|
||||
u16 chip_control;
|
||||
|
@ -691,6 +710,7 @@ static int mt9v032_registered(struct v4l2_subdev *subdev)
|
|||
|
||||
static int mt9v032_open(struct v4l2_subdev *subdev, struct v4l2_subdev_fh *fh)
|
||||
{
|
||||
struct mt9v032 *mt9v032 = to_mt9v032(subdev);
|
||||
struct v4l2_mbus_framefmt *format;
|
||||
struct v4l2_rect *crop;
|
||||
|
||||
|
@ -701,7 +721,12 @@ static int mt9v032_open(struct v4l2_subdev *subdev, struct v4l2_subdev_fh *fh)
|
|||
crop->height = MT9V032_WINDOW_HEIGHT_DEF;
|
||||
|
||||
format = v4l2_subdev_get_try_format(fh, 0);
|
||||
format->code = V4L2_MBUS_FMT_SGRBG10_1X10;
|
||||
|
||||
if (mt9v032->model->color)
|
||||
format->code = V4L2_MBUS_FMT_SGRBG10_1X10;
|
||||
else
|
||||
format->code = V4L2_MBUS_FMT_Y10_1X10;
|
||||
|
||||
format->width = MT9V032_WINDOW_WIDTH_DEF;
|
||||
format->height = MT9V032_WINDOW_HEIGHT_DEF;
|
||||
format->field = V4L2_FIELD_NONE;
|
||||
|
@ -773,6 +798,7 @@ static int mt9v032_probe(struct i2c_client *client,
|
|||
|
||||
mutex_init(&mt9v032->power_lock);
|
||||
mt9v032->pdata = pdata;
|
||||
mt9v032->model = (const void *)did->driver_data;
|
||||
|
||||
v4l2_ctrl_handler_init(&mt9v032->ctrls, 10);
|
||||
|
||||
|
@ -837,7 +863,11 @@ static int mt9v032_probe(struct i2c_client *client,
|
|||
mt9v032->crop.width = MT9V032_WINDOW_WIDTH_DEF;
|
||||
mt9v032->crop.height = MT9V032_WINDOW_HEIGHT_DEF;
|
||||
|
||||
mt9v032->format.code = V4L2_MBUS_FMT_SGRBG10_1X10;
|
||||
if (mt9v032->model->color)
|
||||
mt9v032->format.code = V4L2_MBUS_FMT_SGRBG10_1X10;
|
||||
else
|
||||
mt9v032->format.code = V4L2_MBUS_FMT_Y10_1X10;
|
||||
|
||||
mt9v032->format.width = MT9V032_WINDOW_WIDTH_DEF;
|
||||
mt9v032->format.height = MT9V032_WINDOW_HEIGHT_DEF;
|
||||
mt9v032->format.field = V4L2_FIELD_NONE;
|
||||
|
@ -876,7 +906,8 @@ static int mt9v032_remove(struct i2c_client *client)
|
|||
}
|
||||
|
||||
static const struct i2c_device_id mt9v032_id[] = {
|
||||
{ "mt9v032", 0 },
|
||||
{ "mt9v032", (kernel_ulong_t)&mt9v032_models[MT9V032_MODEL_COLOR] },
|
||||
{ "mt9v032m", (kernel_ulong_t)&mt9v032_models[MT9V032_MODEL_MONO] },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, mt9v032_id);
|
||||
|
|
Loading…
Reference in a new issue