Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 220ddc7f authored by Laurent Pinchart's avatar Laurent Pinchart Committed by Mauro Carvalho Chehab
Browse files

[media] mt9v032: Add support for monochrome models



Identify the model based on the I2C device name and configure formats
accordingly.

Signed-off-by: default avatarLaurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: default avatarMauro Carvalho Chehab <m.chehab@samsung.com>
parent 637f005e
Loading
Loading
Loading
Loading
+34 −3
Original line number Original line Diff line number Diff line
@@ -121,6 +121,24 @@
#define		MT9V032_AGC_ENABLE			(1 << 1)
#define		MT9V032_AGC_ENABLE			(1 << 1)
#define MT9V032_THERMAL_INFO				0xc1
#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 mt9v032 {
	struct v4l2_subdev subdev;
	struct v4l2_subdev subdev;
	struct media_pad pad;
	struct media_pad pad;
@@ -142,6 +160,7 @@ struct mt9v032 {
	struct clk *clk;
	struct clk *clk;


	struct mt9v032_platform_data *pdata;
	struct mt9v032_platform_data *pdata;
	const struct mt9v032_model_info *model;


	u32 sysclk;
	u32 sysclk;
	u16 chip_control;
	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)
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_mbus_framefmt *format;
	struct v4l2_rect *crop;
	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;
	crop->height = MT9V032_WINDOW_HEIGHT_DEF;


	format = v4l2_subdev_get_try_format(fh, 0);
	format = v4l2_subdev_get_try_format(fh, 0);

	if (mt9v032->model->color)
		format->code = V4L2_MBUS_FMT_SGRBG10_1X10;
		format->code = V4L2_MBUS_FMT_SGRBG10_1X10;
	else
		format->code = V4L2_MBUS_FMT_Y10_1X10;

	format->width = MT9V032_WINDOW_WIDTH_DEF;
	format->width = MT9V032_WINDOW_WIDTH_DEF;
	format->height = MT9V032_WINDOW_HEIGHT_DEF;
	format->height = MT9V032_WINDOW_HEIGHT_DEF;
	format->field = V4L2_FIELD_NONE;
	format->field = V4L2_FIELD_NONE;
@@ -773,6 +798,7 @@ static int mt9v032_probe(struct i2c_client *client,


	mutex_init(&mt9v032->power_lock);
	mutex_init(&mt9v032->power_lock);
	mt9v032->pdata = pdata;
	mt9v032->pdata = pdata;
	mt9v032->model = (const void *)did->driver_data;


	v4l2_ctrl_handler_init(&mt9v032->ctrls, 10);
	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.width = MT9V032_WINDOW_WIDTH_DEF;
	mt9v032->crop.height = MT9V032_WINDOW_HEIGHT_DEF;
	mt9v032->crop.height = MT9V032_WINDOW_HEIGHT_DEF;


	if (mt9v032->model->color)
		mt9v032->format.code = V4L2_MBUS_FMT_SGRBG10_1X10;
		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.width = MT9V032_WINDOW_WIDTH_DEF;
	mt9v032->format.height = MT9V032_WINDOW_HEIGHT_DEF;
	mt9v032->format.height = MT9V032_WINDOW_HEIGHT_DEF;
	mt9v032->format.field = V4L2_FIELD_NONE;
	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[] = {
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);
MODULE_DEVICE_TABLE(i2c, mt9v032_id);