blob: 8eb8588cb71bb02938e5e7fba15841981a3fc7ab [file] [edit]
// SPDX-License-Identifier: GPL-2.0
// Copyright (C) 2018 Intel Corporation
#include <linux/acpi.h>
#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/gpio/consumer.h>
#include <linux/i2c.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/pm_runtime.h>
#include <linux/regmap.h>
#include <linux/regulator/consumer.h>
#include <linux/unaligned.h>
#include <media/v4l2-cci.h>
#include <media/v4l2-ctrls.h>
#include <media/v4l2-device.h>
#include <media/v4l2-event.h>
#include <media/v4l2-fwnode.h>
#define IMX355_REG_MODE_SELECT CCI_REG8(0x0100)
#define IMX355_MODE_STANDBY 0x00
#define IMX355_MODE_STREAMING 0x01
/* Chip ID */
#define IMX355_REG_CHIP_ID CCI_REG16(0x0016)
#define IMX355_CHIP_ID 0x0355
#define IMX355_REG_LANE_SEL CCI_REG8(0x0114)
/* PLL registers that depend on the external clock frequency */
#define IMX355_REG_EXTCLK_FREQ CCI_REG16(0x0136)
#define IMX355_REG_PLL_OP_PREDIV CCI_REG8(0x030d)
#define IMX355_REG_PLL_OP_MUL CCI_REG16(0x030e)
#define IMX355_REG_PLL_IVT_PCK_DIV CCI_REG8(0x0301)
#define IMX355_REG_PLL_IVT_SYSCK_DIV CCI_REG8(0x0303)
#define IMX355_PLL_OP_PREDIV 2
#define IMX355_PLL_IVT_PCK_DIV 5
/* V_TIMING internal */
#define IMX355_REG_FLL CCI_REG16(0x0340)
#define IMX355_FLL_MAX 0xffff
#define IMX355_VBLANK_MIN 20
#define IMX355_REG_LLP CCI_REG16(0x0342)
#define IMX355_LLP_MAX 0xffff
#define IMX355_REG_X_ADD_START CCI_REG16(0x0344)
#define IMX355_REG_Y_ADD_START CCI_REG16(0x0346)
#define IMX355_REG_X_ADD_END CCI_REG16(0x0348)
#define IMX355_REG_Y_ADD_END CCI_REG16(0x034a)
#define IMX355_REG_X_OUT_SIZE CCI_REG16(0x034c)
#define IMX355_REG_Y_OUT_SIZE CCI_REG16(0x034e)
/* Exposure control */
#define IMX355_REG_EXPOSURE CCI_REG16(0x0202)
#define IMX355_EXPOSURE_MIN 1
#define IMX355_EXPOSURE_STEP 1
#define IMX355_EXPOSURE_DEFAULT 0x0282
#define IMX355_EXPOSURE_OFFSET 10
/* Analog gain control */
#define IMX355_REG_ANALOG_GAIN CCI_REG16(0x0204)
#define IMX355_ANA_GAIN_MIN 0
#define IMX355_ANA_GAIN_MAX 960
#define IMX355_ANA_GAIN_STEP 1
#define IMX355_ANA_GAIN_DEFAULT 0
/* Digital gain control */
#define IMX355_REG_DPGA_USE_GLOBAL_GAIN CCI_REG8(0x3070)
#define IMX355_REG_DIG_GAIN_GLOBAL CCI_REG16(0x020e)
#define IMX355_DGTL_GAIN_MIN 256
#define IMX355_DGTL_GAIN_MAX 4095
#define IMX355_DGTL_GAIN_STEP 1
#define IMX355_DGTL_GAIN_DEFAULT 256
/* Test Pattern Control */
#define IMX355_REG_TEST_PATTERN CCI_REG16(0x0600)
#define IMX355_TEST_PATTERN_DISABLED 0
#define IMX355_TEST_PATTERN_SOLID_COLOR 1
#define IMX355_TEST_PATTERN_COLOR_BARS 2
#define IMX355_TEST_PATTERN_GRAY_COLOR_BARS 3
#define IMX355_TEST_PATTERN_PN9 4
#define IMX355_REG_REQ_LINK_BIT_RATE CCI_REG16(0x0820)
#define IMX355_REG_BINNING_MODE CCI_REG8(0x0900)
#define IMX355_REG_BINNING_TYPE CCI_REG8(0x0901)
#define IMX355_REG_BINNING_WEIGHTING CCI_REG8(0x0902)
/* Flip Control */
#define IMX355_REG_ORIENTATION CCI_REG8(0x0101)
#define IMX355_PIXEL_ARRAY_TOP 0
#define IMX355_PIXEL_ARRAY_LEFT 0
#define IMX355_PIXEL_ARRAY_WIDTH 3280
#define IMX355_PIXEL_ARRAY_HEIGHT 2464
struct imx355_reg_list {
u32 num_of_regs;
const struct cci_reg_sequence *regs;
};
/* Mode : resolution and related config&values */
struct imx355_mode {
/* Frame width */
u32 width;
/* Frame height */
u32 height;
struct v4l2_rect crop;
/* V-timing */
u32 fll_def;
/* H-timing */
u32 llp;
/* Default register values */
struct imx355_reg_list reg_list;
};
struct imx355_clk_params {
u32 ext_clk;
u16 extclk_freq; /* External clock (MHz) in 8.8 fixed point) */
u16 pll_op_mpy[2]; /* OP system PLL multiplier */
u8 pll_op_prediv[2]; /* OP system pre PLL d */
};
/*
* The clock tree is in single PLL mode, so PREDIV_VT and MPY_IVT do nothing.
* In 4 lane mode the MIPI rate is 360Mhz (720Mbit/s) and pixel rate is
* 288MPix/s.
* In 2 lane mode the MIPI rate is 444MHz (888Mbit/s) and pixel rate
* 177.6MPix/s with a 24MHz clock, and 441.6MHz (883.2Mbit/s) and 176.6MPix/s
* with a 19.2MHz clock.
*/
static const struct imx355_clk_params imx355_clk_params[] = {
{
.ext_clk = 19200000,
.extclk_freq = 0x1333,
.pll_op_mpy = { 75, 92 },
.pll_op_prediv = { 2, 2 }
},
{
.ext_clk = 24000000,
.extclk_freq = 0x1800,
.pll_op_mpy = { 60, 111 },
.pll_op_prediv = { 2, 3 }
},
};
struct imx355_hwcfg {
s64 link_freq_menu;
unsigned long link_freq_bitmap;
unsigned int num_lanes;
};
struct imx355 {
struct device *dev;
struct clk *clk;
struct regmap *regmap;
struct v4l2_subdev sd;
struct media_pad pad;
struct v4l2_ctrl_handler ctrl_handler;
/* V4L2 Controls */
struct v4l2_ctrl *link_freq;
struct v4l2_ctrl *vblank;
struct v4l2_ctrl *hblank;
struct v4l2_ctrl *exposure;
struct v4l2_ctrl *vflip;
struct v4l2_ctrl *hflip;
struct imx355_hwcfg *hwcfg;
const struct imx355_clk_params *clk_params;
struct gpio_desc *reset_gpio;
struct regulator_bulk_data *supplies;
};
static const struct regulator_bulk_data imx355_supplies[] = {
{ .supply = "avdd" },
{ .supply = "dvdd" },
{ .supply = "dovdd" },
};
static const struct cci_reg_sequence imx355_global_regs[] = {
{ CCI_REG8(0x304e), 0x03 },
{ CCI_REG8(0x4348), 0x16 },
{ CCI_REG8(0x4350), 0x19 },
{ CCI_REG8(0x4408), 0x0a },
{ CCI_REG8(0x440c), 0x0b },
{ CCI_REG8(0x4411), 0x5f },
{ CCI_REG8(0x4412), 0x2c },
{ CCI_REG8(0x4623), 0x00 },
{ CCI_REG8(0x462c), 0x0f },
{ CCI_REG8(0x462d), 0x00 },
{ CCI_REG8(0x462e), 0x00 },
{ CCI_REG8(0x4684), 0x54 },
{ CCI_REG8(0x480a), 0x07 },
{ CCI_REG8(0x4908), 0x07 },
{ CCI_REG8(0x4909), 0x07 },
{ CCI_REG8(0x490d), 0x0a },
{ CCI_REG8(0x491e), 0x0f },
{ CCI_REG8(0x4921), 0x06 },
{ CCI_REG8(0x4923), 0x28 },
{ CCI_REG8(0x4924), 0x28 },
{ CCI_REG8(0x4925), 0x29 },
{ CCI_REG8(0x4926), 0x29 },
{ CCI_REG8(0x4927), 0x1f },
{ CCI_REG8(0x4928), 0x20 },
{ CCI_REG8(0x4929), 0x20 },
{ CCI_REG8(0x492a), 0x20 },
{ CCI_REG8(0x492c), 0x05 },
{ CCI_REG8(0x492d), 0x06 },
{ CCI_REG8(0x492e), 0x06 },
{ CCI_REG8(0x492f), 0x06 },
{ CCI_REG8(0x4930), 0x03 },
{ CCI_REG8(0x4931), 0x04 },
{ CCI_REG8(0x4932), 0x04 },
{ CCI_REG8(0x4933), 0x05 },
{ CCI_REG8(0x595e), 0x01 },
{ CCI_REG8(0x5963), 0x01 },
{ CCI_REG8(0x3030), 0x01 },
{ CCI_REG8(0x3031), 0x01 },
{ CCI_REG8(0x3045), 0x01 },
{ CCI_REG8(0x4010), 0x00 },
{ CCI_REG8(0x4011), 0x00 },
{ CCI_REG8(0x4012), 0x00 },
{ CCI_REG8(0x4013), 0x01 },
{ CCI_REG8(0x68a8), 0xfe },
{ CCI_REG8(0x68a9), 0xff },
{ CCI_REG8(0x6888), 0x00 },
{ CCI_REG8(0x6889), 0x00 },
{ CCI_REG8(0x68b0), 0x00 },
{ CCI_REG8(0x3058), 0x00 },
{ CCI_REG8(0x305a), 0x00 },
{ CCI_REG8(0x0112), 0x0a },
{ CCI_REG8(0x0113), 0x0a },
{ IMX355_REG_PLL_IVT_PCK_DIV, IMX355_PLL_IVT_PCK_DIV },
{ CCI_REG8(0x0303), 0x01 },
{ CCI_REG8(0x0305), 0x02 },
{ CCI_REG8(0x0306), 0x00 },
{ CCI_REG8(0x0307), 0x78 },
{ CCI_REG8(0x030b), 0x01 },
{ IMX355_REG_PLL_OP_PREDIV, IMX355_PLL_OP_PREDIV },
{ CCI_REG8(0x0310), 0x00 },
{ CCI_REG8(0x0220), 0x00 },
{ CCI_REG8(0x0222), 0x01 },
{ CCI_REG8(0x3088), 0x04 },
{ CCI_REG8(0x6813), 0x02 },
{ CCI_REG8(0x6835), 0x07 },
{ CCI_REG8(0x6836), 0x01 },
{ CCI_REG8(0x6837), 0x04 },
{ CCI_REG8(0x684d), 0x07 },
{ CCI_REG8(0x684e), 0x01 },
{ CCI_REG8(0x684f), 0x04 },
};
static const struct cci_reg_sequence mode_3268x2448_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_3264x2448_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_3280x2464_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1940x1096_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1936x1096_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1924x1080_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1920x1080_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1640x1232_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1640x922_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1300x736_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1296x736_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1284x720_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_1280x720_regs[] = {
{ CCI_REG8(0x0700), 0x00 },
{ CCI_REG8(0x0701), 0x10 },
};
static const struct cci_reg_sequence mode_820x616_regs[] = {
{ CCI_REG8(0x0700), 0x02 },
{ CCI_REG8(0x0701), 0x78 },
};
static const char * const imx355_test_pattern_menu[] = {
"Disabled",
"Solid Colour",
"Eight Vertical Colour Bars",
"Colour Bars With Fade to Grey",
"Pseudorandom Sequence (PN9)",
};
/* Mode configs */
static const struct imx355_mode supported_modes[] = {
{
.width = 3280,
.height = 2464,
.crop = {
.width = 3280,
.height = 2464,
.left = 0,
.top = 0,
},
.fll_def = 2615,
.llp = 3672,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_3280x2464_regs),
.regs = mode_3280x2464_regs,
},
},
{
.width = 3268,
.height = 2448,
.crop = {
.width = 3268,
.height = 2448,
.left = 8,
.top = 8,
},
.fll_def = 2615,
.llp = 3672,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_3268x2448_regs),
.regs = mode_3268x2448_regs,
},
},
{
.width = 3264,
.height = 2448,
.crop = {
.width = 3264,
.height = 2448,
.left = 8,
.top = 8,
},
.fll_def = 2615,
.llp = 3672,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_3264x2448_regs),
.regs = mode_3264x2448_regs,
},
},
{
.width = 1940,
.height = 1096,
.crop = {
.width = 1940,
.height = 1096,
.left = 672,
.top = 684,
},
.fll_def = 1306,
.llp = 3672,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1940x1096_regs),
.regs = mode_1940x1096_regs,
},
},
{
.width = 1936,
.height = 1096,
.crop = {
.width = 1936,
.height = 1096,
.left = 672,
.top = 684,
},
.fll_def = 1306,
.llp = 3672,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1936x1096_regs),
.regs = mode_1936x1096_regs,
},
},
{
.width = 1924,
.height = 1080,
.crop = {
.width = 1924,
.height = 1080,
.left = 680,
.top = 692,
},
.fll_def = 1306,
.llp = 3672,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1924x1080_regs),
.regs = mode_1924x1080_regs,
},
},
{
.width = 1920,
.height = 1080,
.crop = {
.width = 1920,
.height = 1080,
.left = 680,
.top = 692,
},
.fll_def = 1306,
.llp = 3672,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1920x1080_regs),
.regs = mode_1920x1080_regs,
},
},
{
.width = 1640,
.height = 1232,
.crop = {
.width = 3280,
.height = 2464,
.left = 0,
.top = 0,
},
.fll_def = 1306,
.llp = 1836,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1640x1232_regs),
.regs = mode_1640x1232_regs,
},
},
{
.width = 1640,
.height = 922,
.crop = {
.width = 3280,
.height = 1844,
.left = 0,
.top = 304,
},
.fll_def = 1306,
.llp = 1836,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1640x922_regs),
.regs = mode_1640x922_regs,
},
},
{
.width = 1300,
.height = 736,
.crop = {
.width = 2600,
.height = 1472,
.left = 344,
.top = 496,
},
.fll_def = 1306,
.llp = 1836,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1300x736_regs),
.regs = mode_1300x736_regs,
},
},
{
.width = 1296,
.height = 736,
.crop = {
.width = 2592,
.height = 1472,
.left = 344,
.top = 496,
},
.fll_def = 1306,
.llp = 1836,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1296x736_regs),
.regs = mode_1296x736_regs,
},
},
{
.width = 1284,
.height = 720,
.crop = {
.width = 2568,
.height = 1440,
.left = 360,
.top = 512,
},
.fll_def = 1306,
.llp = 1836,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1284x720_regs),
.regs = mode_1284x720_regs,
},
},
{
.width = 1280,
.height = 720,
.crop = {
.width = 2560,
.height = 1440,
.left = 360,
.top = 512,
},
.fll_def = 1306,
.llp = 1836,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1280x720_regs),
.regs = mode_1280x720_regs,
},
},
{
.width = 820,
.height = 616,
.crop = {
.width = 3280,
.height = 2464,
.left = 0,
.top = 0,
},
.fll_def = 652,
.llp = 3672,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_820x616_regs),
.regs = mode_820x616_regs,
},
},
};
static inline struct imx355 *to_imx355(struct v4l2_subdev *_sd)
{
return container_of(_sd, struct imx355, sd);
}
/* Get bayer order based on flip setting. */
static u32 imx355_get_format_code(struct imx355 *imx355)
{
/*
* Only one bayer order is supported.
* It depends on the flip settings.
*/
u32 code;
static const u32 codes[2][2] = {
{ MEDIA_BUS_FMT_SRGGB10_1X10, MEDIA_BUS_FMT_SGRBG10_1X10, },
{ MEDIA_BUS_FMT_SGBRG10_1X10, MEDIA_BUS_FMT_SBGGR10_1X10, },
};
code = codes[imx355->vflip->val][imx355->hflip->val];
return code;
}
static int imx355_set_ctrl(struct v4l2_ctrl *ctrl)
{
struct imx355 *imx355 = container_of(ctrl->handler,
struct imx355, ctrl_handler);
const struct v4l2_mbus_framefmt *format = NULL;
struct v4l2_subdev_state *state;
s64 max;
int ret;
state = v4l2_subdev_get_locked_active_state(&imx355->sd);
format = v4l2_subdev_state_get_format(state, 0);
/* Propagate change of current control to all related controls */
switch (ctrl->id) {
case V4L2_CID_VBLANK:
/* Update max exposure while meeting expected vblanking */
max = format->height + ctrl->val - IMX355_EXPOSURE_OFFSET;
__v4l2_ctrl_modify_range(imx355->exposure,
imx355->exposure->minimum,
max, imx355->exposure->step, max);
break;
}
/*
* Applying V4L2 control value only happens
* when power is up for streaming
*/
if (!pm_runtime_get_if_in_use(imx355->dev))
return 0;
switch (ctrl->id) {
case V4L2_CID_ANALOGUE_GAIN:
/* Analog gain = 1024/(1024 - ctrl->val) times */
ret = cci_write(imx355->regmap, IMX355_REG_ANALOG_GAIN,
ctrl->val, NULL);
break;
case V4L2_CID_DIGITAL_GAIN:
ret = cci_write(imx355->regmap, IMX355_REG_DIG_GAIN_GLOBAL,
ctrl->val, NULL);
break;
case V4L2_CID_EXPOSURE:
ret = cci_write(imx355->regmap, IMX355_REG_EXPOSURE,
ctrl->val, NULL);
break;
case V4L2_CID_VBLANK:
/* Update FLL that meets expected vertical blanking */
ret = cci_write(imx355->regmap, IMX355_REG_FLL,
format->height + ctrl->val, NULL);
break;
case V4L2_CID_TEST_PATTERN:
ret = cci_write(imx355->regmap, IMX355_REG_TEST_PATTERN,
ctrl->val, NULL);
break;
case V4L2_CID_HFLIP:
case V4L2_CID_VFLIP:
ret = cci_write(imx355->regmap, IMX355_REG_ORIENTATION,
imx355->hflip->val | imx355->vflip->val << 1,
NULL);
break;
default:
ret = -EINVAL;
dev_info(imx355->dev, "ctrl(id:0x%x,val:0x%x) is not handled",
ctrl->id, ctrl->val);
break;
}
pm_runtime_put(imx355->dev);
return ret;
}
static const struct v4l2_ctrl_ops imx355_ctrl_ops = {
.s_ctrl = imx355_set_ctrl,
};
static int imx355_enum_mbus_code(struct v4l2_subdev *sd,
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_mbus_code_enum *code)
{
struct imx355 *imx355 = to_imx355(sd);
if (code->index > 0)
return -EINVAL;
code->code = imx355_get_format_code(imx355);
return 0;
}
static int imx355_enum_frame_size(struct v4l2_subdev *sd,
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_frame_size_enum *fse)
{
struct imx355 *imx355 = to_imx355(sd);
if (fse->index >= ARRAY_SIZE(supported_modes))
return -EINVAL;
if (fse->code != imx355_get_format_code(imx355)) {
return -EINVAL;
}
fse->min_width = supported_modes[fse->index].width;
fse->max_width = fse->min_width;
fse->min_height = supported_modes[fse->index].height;
fse->max_height = fse->min_height;
return 0;
}
static void imx355_update_pad_format(struct imx355 *imx355,
const struct imx355_mode *mode,
struct v4l2_subdev_format *fmt)
{
fmt->format.width = mode->width;
fmt->format.height = mode->height;
fmt->format.code = imx355_get_format_code(imx355);
fmt->format.field = V4L2_FIELD_NONE;
fmt->format.colorspace = V4L2_COLORSPACE_RAW;
fmt->format.ycbcr_enc = V4L2_YCBCR_ENC_601;
fmt->format.quantization = V4L2_QUANTIZATION_FULL_RANGE;
fmt->format.xfer_func = V4L2_XFER_FUNC_NONE;
}
static int
imx355_set_pad_format(struct v4l2_subdev *sd,
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_format *fmt)
{
struct imx355 *imx355 = to_imx355(sd);
const struct imx355_mode *mode;
struct v4l2_mbus_framefmt *framefmt;
struct v4l2_rect *crop;
s64 h_blank;
/*
* Only one bayer order is supported.
* It depends on the flip settings.
*/
fmt->format.code = imx355_get_format_code(imx355);
mode = v4l2_find_nearest_size(supported_modes,
ARRAY_SIZE(supported_modes),
width, height,
fmt->format.width, fmt->format.height);
imx355_update_pad_format(imx355, mode, fmt);
framefmt = v4l2_subdev_state_get_format(sd_state, 0);
*framefmt = fmt->format;
crop = v4l2_subdev_state_get_crop(sd_state, 0);
crop->width = mode->crop.width;
crop->height = mode->crop.height;
crop->left = mode->crop.left;
crop->top = mode->crop.top;
if (fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) {
/* Update limits and set FPS to default */
__v4l2_ctrl_modify_range(imx355->vblank, IMX355_VBLANK_MIN,
IMX355_FLL_MAX - mode->height, 1,
mode->fll_def - mode->height);
__v4l2_ctrl_s_ctrl(imx355->vblank, mode->fll_def - mode->height);
h_blank = mode->llp - mode->width;
/*
* Currently hblank is not changeable.
* So FPS control is done only by vblank.
*/
__v4l2_ctrl_modify_range(imx355->hblank, h_blank,
h_blank, 1, h_blank);
}
return 0;
}
static int imx355_get_selection(struct v4l2_subdev *sd,
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_selection *sel)
{
switch (sel->target) {
case V4L2_SEL_TGT_CROP:
sel->r = *v4l2_subdev_state_get_crop(sd_state, 0);
return 0;
case V4L2_SEL_TGT_CROP_DEFAULT:
case V4L2_SEL_TGT_CROP_BOUNDS:
case V4L2_SEL_TGT_NATIVE_SIZE:
sel->r.top = IMX355_PIXEL_ARRAY_TOP;
sel->r.left = IMX355_PIXEL_ARRAY_LEFT;
sel->r.width = IMX355_PIXEL_ARRAY_WIDTH;
sel->r.height = IMX355_PIXEL_ARRAY_HEIGHT;
return 0;
}
return -EINVAL;
}
static int imx355_entity_init_state(struct v4l2_subdev *subdev,
struct v4l2_subdev_state *sd_state)
{
struct v4l2_subdev_format fmt = { };
fmt.which = sd_state ? V4L2_SUBDEV_FORMAT_TRY : V4L2_SUBDEV_FORMAT_ACTIVE;
fmt.format.code = MEDIA_BUS_FMT_SRGGB10_1X10;
fmt.format.width = supported_modes[0].width;
fmt.format.height = supported_modes[0].height;
imx355_set_pad_format(subdev, sd_state, &fmt);
return 0;
}
/* Start streaming */
static int imx355_start_streaming(struct imx355 *imx355)
{
const struct v4l2_mbus_framefmt *fmt;
struct v4l2_subdev_state *state;
const struct imx355_mode *mode;
int lane_idx = imx355->hwcfg->num_lanes == 4 ? 0 : 1;
struct v4l2_rect *crop;
u64 link_bitrate;
u8 binning_mode;
int ret = 0;
/* Global Setting */
cci_multi_reg_write(imx355->regmap, imx355_global_regs,
ARRAY_SIZE(imx355_global_regs), &ret);
/* Apply values of current mode */
state = v4l2_subdev_get_locked_active_state(&imx355->sd);
fmt = v4l2_subdev_state_get_format(state, 0);
crop = v4l2_subdev_state_get_crop(state, 0);
mode = v4l2_find_nearest_size(supported_modes,
ARRAY_SIZE(supported_modes),
width, height, fmt->width, fmt->height);
cci_multi_reg_write(imx355->regmap, mode->reg_list.regs,
mode->reg_list.num_of_regs, &ret);
/* Set readout crop and size registers */
cci_write(imx355->regmap, IMX355_REG_X_ADD_START, crop->left,
&ret);
cci_write(imx355->regmap, IMX355_REG_Y_ADD_START, crop->top, &ret);
cci_write(imx355->regmap, IMX355_REG_X_ADD_END,
crop->width + crop->left - 1, &ret);
cci_write(imx355->regmap, IMX355_REG_Y_ADD_END,
crop->height + crop->top - 1, &ret);
cci_write(imx355->regmap, IMX355_REG_X_OUT_SIZE, fmt->width, &ret);
cci_write(imx355->regmap, IMX355_REG_Y_OUT_SIZE, fmt->height, &ret);
binning_mode = ((crop->width / fmt->width) << 4) |
(crop->height / fmt->height);
cci_write(imx355->regmap, IMX355_REG_BINNING_MODE,
binning_mode == 0x11 ? 0x00 : 0x01, &ret);
cci_write(imx355->regmap, IMX355_REG_BINNING_TYPE, binning_mode, &ret);
cci_write(imx355->regmap, IMX355_REG_BINNING_WEIGHTING, 0x00, &ret);
/* Set PLL registers for the external clock frequency */
cci_write(imx355->regmap, IMX355_REG_EXTCLK_FREQ,
imx355->clk_params->extclk_freq, &ret);
cci_write(imx355->regmap, IMX355_REG_PLL_OP_MUL,
imx355->clk_params->pll_op_mpy[lane_idx], &ret);
cci_write(imx355->regmap, IMX355_REG_PLL_OP_PREDIV,
imx355->clk_params->pll_op_prediv[lane_idx], &ret);
cci_write(imx355->regmap, IMX355_REG_PLL_IVT_SYSCK_DIV,
lane_idx ? 2 : 1, &ret);
/* Set MIPI configuration */
cci_write(imx355->regmap, IMX355_REG_LANE_SEL,
imx355->hwcfg->num_lanes - 1, &ret);
link_bitrate = imx355->link_freq->qmenu_int[imx355->link_freq->val] *
imx355->hwcfg->num_lanes * 2;
do_div(link_bitrate, 1000000);
cci_write(imx355->regmap, IMX355_REG_REQ_LINK_BIT_RATE, link_bitrate,
&ret);
/* set digital gain control to all color mode */
cci_write(imx355->regmap, IMX355_REG_DPGA_USE_GLOBAL_GAIN, 1, &ret);
/* set line length */
cci_write(imx355->regmap, IMX355_REG_LLP,
imx355->hblank->val + fmt->width, &ret);
/* Apply customized values from user */
if (!ret)
ret = __v4l2_ctrl_handler_setup(imx355->sd.ctrl_handler);
cci_write(imx355->regmap, IMX355_REG_MODE_SELECT, IMX355_MODE_STREAMING,
&ret);
return ret;
}
/* Stop streaming */
static int imx355_stop_streaming(struct imx355 *imx355)
{
return cci_write(imx355->regmap, IMX355_REG_MODE_SELECT,
IMX355_MODE_STANDBY, NULL);
}
static int imx355_set_stream(struct v4l2_subdev *sd, int enable)
{
struct imx355 *imx355 = to_imx355(sd);
struct v4l2_subdev_state *state;
int ret = 0;
state = v4l2_subdev_lock_and_get_active_state(sd);
if (enable) {
ret = pm_runtime_resume_and_get(imx355->dev);
if (ret < 0)
goto err_unlock;
/*
* Apply default & customized values
* and then start streaming.
*/
ret = imx355_start_streaming(imx355);
if (ret)
goto err_rpm_put;
} else {
imx355_stop_streaming(imx355);
pm_runtime_put_autosuspend(imx355->dev);
}
/* vflip and hflip cannot change during streaming */
__v4l2_ctrl_grab(imx355->vflip, enable);
__v4l2_ctrl_grab(imx355->hflip, enable);
v4l2_subdev_unlock_state(state);
return ret;
err_rpm_put:
pm_runtime_put_autosuspend(imx355->dev);
err_unlock:
v4l2_subdev_unlock_state(state);
return ret;
}
/* Verify chip ID */
static int imx355_identify_module(struct imx355 *imx355)
{
int ret;
u64 val;
ret = cci_read(imx355->regmap, IMX355_REG_CHIP_ID, &val, NULL);
if (ret)
return ret;
if (val != IMX355_CHIP_ID) {
dev_err(imx355->dev, "chip id mismatch: %x!=%llx",
IMX355_CHIP_ID, val);
return -EIO;
}
return 0;
}
static const struct v4l2_subdev_core_ops imx355_subdev_core_ops = {
.subscribe_event = v4l2_ctrl_subdev_subscribe_event,
.unsubscribe_event = v4l2_event_subdev_unsubscribe,
};
static const struct v4l2_subdev_video_ops imx355_video_ops = {
.s_stream = imx355_set_stream,
};
static const struct v4l2_subdev_pad_ops imx355_pad_ops = {
.enum_mbus_code = imx355_enum_mbus_code,
.get_fmt = v4l2_subdev_get_fmt,
.set_fmt = imx355_set_pad_format,
.enum_frame_size = imx355_enum_frame_size,
.get_selection = imx355_get_selection,
};
static const struct v4l2_subdev_ops imx355_subdev_ops = {
.core = &imx355_subdev_core_ops,
.video = &imx355_video_ops,
.pad = &imx355_pad_ops,
};
static const struct media_entity_operations imx355_subdev_entity_ops = {
.link_validate = v4l2_subdev_link_validate,
};
static const struct v4l2_subdev_internal_ops imx355_internal_ops = {
.init_state = imx355_entity_init_state,
};
static int imx355_power_off(struct device *dev)
{
struct i2c_client *client = container_of(dev, struct i2c_client, dev);
struct v4l2_subdev *sd = i2c_get_clientdata(client);
struct imx355 *imx355 = to_imx355(sd);
gpiod_set_value_cansleep(imx355->reset_gpio, 1);
regulator_bulk_disable(ARRAY_SIZE(imx355_supplies), imx355->supplies);
clk_disable_unprepare(imx355->clk);
return 0;
}
static int imx355_power_on(struct device *dev)
{
struct i2c_client *client = container_of(dev, struct i2c_client, dev);
struct v4l2_subdev *sd = i2c_get_clientdata(client);
struct imx355 *imx355 = to_imx355(sd);
int ret;
ret = clk_prepare_enable(imx355->clk);
if (ret)
return dev_err_probe(dev, ret, "failed to enable clocks");
ret = regulator_bulk_enable(ARRAY_SIZE(imx355_supplies),
imx355->supplies);
if (ret) {
dev_err_probe(dev, ret, "failed to enable regulators");
goto error_disable_clocks;
}
usleep_range(1000, 2000);
gpiod_set_value_cansleep(imx355->reset_gpio, 0);
usleep_range(10000, 11000);
return 0;
error_disable_clocks:
clk_disable_unprepare(imx355->clk);
return ret;
}
static DEFINE_RUNTIME_DEV_PM_OPS(imx355_pm_ops, imx355_power_off,
imx355_power_on, NULL);
/* Initialize control handlers */
static int imx355_init_controls(struct imx355 *imx355)
{
struct v4l2_fwnode_device_properties props;
struct v4l2_ctrl_handler *ctrl_hdlr;
const struct imx355_mode *mode = &supported_modes[0];
s64 exposure_max;
s64 vblank_def;
s64 hblank;
u64 pixel_rate;
int ret;
ctrl_hdlr = &imx355->ctrl_handler;
ret = v4l2_ctrl_handler_init(ctrl_hdlr, 12);
if (ret)
return ret;
imx355->link_freq = v4l2_ctrl_new_int_menu(ctrl_hdlr, &imx355_ctrl_ops,
V4L2_CID_LINK_FREQ, 0, 0,
&imx355->hwcfg->link_freq_menu);
if (imx355->link_freq)
imx355->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;
/* pixel_rate = link_freq * 2 * nr_of_lanes / bits_per_sample */
pixel_rate = imx355->hwcfg->link_freq_menu * 2 * imx355->hwcfg->num_lanes;
do_div(pixel_rate, 10);
v4l2_ctrl_new_std(ctrl_hdlr, &imx355_ctrl_ops, V4L2_CID_PIXEL_RATE,
pixel_rate, pixel_rate, 1, pixel_rate);
/* Initialize vblank/hblank/exposure parameters based on current mode */
vblank_def = mode->fll_def - mode->height;
imx355->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx355_ctrl_ops,
V4L2_CID_VBLANK, IMX355_VBLANK_MIN,
IMX355_FLL_MAX - mode->height,
1, vblank_def);
hblank = mode->llp - mode->width;
imx355->hblank = v4l2_ctrl_new_std(ctrl_hdlr, NULL, V4L2_CID_HBLANK,
hblank, hblank, 1, hblank);
if (imx355->hblank)
imx355->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY;
/* fll >= exposure time + adjust parameter (default value is 10) */
exposure_max = mode->fll_def - IMX355_EXPOSURE_OFFSET;
imx355->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &imx355_ctrl_ops,
V4L2_CID_EXPOSURE,
IMX355_EXPOSURE_MIN, exposure_max,
IMX355_EXPOSURE_STEP,
IMX355_EXPOSURE_DEFAULT);
imx355->hflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx355_ctrl_ops,
V4L2_CID_HFLIP, 0, 1, 1, 0);
if (imx355->hflip)
imx355->hflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT;
imx355->vflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx355_ctrl_ops,
V4L2_CID_VFLIP, 0, 1, 1, 0);
if (imx355->vflip)
imx355->vflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT;
v4l2_ctrl_new_std(ctrl_hdlr, &imx355_ctrl_ops, V4L2_CID_ANALOGUE_GAIN,
IMX355_ANA_GAIN_MIN, IMX355_ANA_GAIN_MAX,
IMX355_ANA_GAIN_STEP, IMX355_ANA_GAIN_DEFAULT);
/* Digital gain */
v4l2_ctrl_new_std(ctrl_hdlr, &imx355_ctrl_ops, V4L2_CID_DIGITAL_GAIN,
IMX355_DGTL_GAIN_MIN, IMX355_DGTL_GAIN_MAX,
IMX355_DGTL_GAIN_STEP, IMX355_DGTL_GAIN_DEFAULT);
v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &imx355_ctrl_ops,
V4L2_CID_TEST_PATTERN,
ARRAY_SIZE(imx355_test_pattern_menu) - 1,
0, 0, imx355_test_pattern_menu);
if (ctrl_hdlr->error) {
ret = ctrl_hdlr->error;
dev_err(imx355->dev, "control init failed: %d", ret);
goto error;
}
ret = v4l2_fwnode_device_parse(imx355->dev, &props);
if (ret)
goto error;
ret = v4l2_ctrl_new_fwnode_properties(ctrl_hdlr, &imx355_ctrl_ops,
&props);
if (ret)
goto error;
imx355->sd.ctrl_handler = ctrl_hdlr;
return 0;
error:
v4l2_ctrl_handler_free(ctrl_hdlr);
return ret;
}
static struct imx355_hwcfg *imx355_get_hwcfg(struct imx355 *imx355)
{
struct device *dev = imx355->dev;
struct imx355_hwcfg *cfg;
struct v4l2_fwnode_endpoint bus_cfg = {
.bus_type = V4L2_MBUS_CSI2_DPHY
};
const struct imx355_clk_params *clk = imx355->clk_params;
struct fwnode_handle *ep;
struct fwnode_handle *fwnode = dev_fwnode(dev);
int lane_idx;
int ret;
if (!fwnode)
return NULL;
ep = fwnode_graph_get_next_endpoint(fwnode, NULL);
if (!ep)
return NULL;
ret = v4l2_fwnode_endpoint_alloc_parse(ep, &bus_cfg);
if (ret)
goto out_err;
cfg = devm_kzalloc(dev, sizeof(*cfg), GFP_KERNEL);
if (!cfg)
goto out_err;
if (bus_cfg.bus.mipi_csi2.num_data_lanes != 2 &&
bus_cfg.bus.mipi_csi2.num_data_lanes != 4)
goto out_err;
cfg->num_lanes = bus_cfg.bus.mipi_csi2.num_data_lanes;
lane_idx = cfg->num_lanes == 4 ? 0 : 1;
cfg->link_freq_menu = (clk->ext_clk * clk->pll_op_mpy[lane_idx]) /
(clk->pll_op_prediv[lane_idx] * 2);
ret = v4l2_link_freq_to_bitmap(dev, bus_cfg.link_frequencies,
bus_cfg.nr_of_link_frequencies,
&cfg->link_freq_menu, 1,
&cfg->link_freq_bitmap);
if (ret)
goto out_err;
v4l2_fwnode_endpoint_free(&bus_cfg);
fwnode_handle_put(ep);
return cfg;
out_err:
v4l2_fwnode_endpoint_free(&bus_cfg);
fwnode_handle_put(ep);
return NULL;
}
static int imx355_probe(struct i2c_client *client)
{
struct imx355 *imx355;
unsigned long freq;
int ret;
imx355 = devm_kzalloc(&client->dev, sizeof(*imx355), GFP_KERNEL);
if (!imx355)
return -ENOMEM;
imx355->dev = &client->dev;
imx355->regmap = devm_cci_regmap_init_i2c(client, 16);
if (IS_ERR(imx355->regmap))
return dev_err_probe(imx355->dev, PTR_ERR(imx355->regmap),
"Unable to initialize I2C\n");
imx355->clk = devm_v4l2_sensor_clk_get(imx355->dev, NULL);
if (IS_ERR(imx355->clk))
return dev_err_probe(imx355->dev, PTR_ERR(imx355->clk),
"failed to get clock\n");
freq = clk_get_rate(imx355->clk);
for (unsigned int i = 0; i < ARRAY_SIZE(imx355_clk_params); i++) {
if (freq == imx355_clk_params[i].ext_clk) {
imx355->clk_params = &imx355_clk_params[i];
break;
}
}
if (!imx355->clk_params)
return dev_err_probe(imx355->dev, -EINVAL,
"external clock %lu is not supported\n",
freq);
ret = devm_regulator_bulk_get_const(imx355->dev,
ARRAY_SIZE(imx355_supplies),
imx355_supplies,
&imx355->supplies);
if (ret) {
dev_err_probe(imx355->dev, ret, "could not get regulators");
return ret;
}
imx355->reset_gpio = devm_gpiod_get_optional(imx355->dev, "reset",
GPIOD_OUT_HIGH);
if (IS_ERR(imx355->reset_gpio)) {
ret = dev_err_probe(imx355->dev, PTR_ERR(imx355->reset_gpio),
"failed to get gpios");
return ret;
}
/* Initialize subdev */
v4l2_i2c_subdev_init(&imx355->sd, client, &imx355_subdev_ops);
imx355->hwcfg = imx355_get_hwcfg(imx355);
if (!imx355->hwcfg) {
dev_err(imx355->dev, "failed to get hwcfg");
return -ENODEV;
}
ret = imx355_power_on(imx355->dev);
if (ret)
return ret;
/* Check module identity */
ret = imx355_identify_module(imx355);
if (ret) {
dev_err(imx355->dev, "failed to find sensor: %d", ret);
goto error_power_off;
}
ret = imx355_init_controls(imx355);
if (ret) {
dev_err(imx355->dev, "failed to init controls: %d", ret);
goto error_power_off;
}
/* Initialize subdev */
imx355->sd.internal_ops = &imx355_internal_ops;
imx355->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE |
V4L2_SUBDEV_FL_HAS_EVENTS;
imx355->sd.entity.ops = &imx355_subdev_entity_ops;
imx355->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;
/* Initialize source pad */
imx355->pad.flags = MEDIA_PAD_FL_SOURCE;
ret = media_entity_pads_init(&imx355->sd.entity, 1, &imx355->pad);
if (ret) {
dev_err(imx355->dev, "failed to init entity pads: %d", ret);
goto error_handler_free;
}
imx355->sd.state_lock = imx355->ctrl_handler.lock;
ret = v4l2_subdev_init_finalize(&imx355->sd);
if (ret < 0) {
dev_err_probe(imx355->dev, ret, "subdev init error\n");
goto error_media_entity_free;
}
/*
* Device is already turned on by i2c-core with ACPI domain PM.
* Enable runtime PM and turn off the device.
*/
pm_runtime_set_active(imx355->dev);
pm_runtime_enable(imx355->dev);
pm_runtime_set_autosuspend_delay(imx355->dev, 1000);
pm_runtime_use_autosuspend(imx355->dev);
ret = v4l2_async_register_subdev_sensor(&imx355->sd);
if (ret < 0)
goto error_subdev_cleanup_runtime_pm;
pm_runtime_idle(imx355->dev);
return 0;
error_subdev_cleanup_runtime_pm:
pm_runtime_disable(imx355->dev);
pm_runtime_set_suspended(imx355->dev);
pm_runtime_dont_use_autosuspend(imx355->dev);
v4l2_subdev_cleanup(&imx355->sd);
error_media_entity_free:
media_entity_cleanup(&imx355->sd.entity);
error_handler_free:
v4l2_ctrl_handler_free(imx355->sd.ctrl_handler);
error_power_off:
imx355_power_off(imx355->dev);
return ret;
}
static void imx355_remove(struct i2c_client *client)
{
struct v4l2_subdev *sd = i2c_get_clientdata(client);
struct imx355 *imx355 = to_imx355(sd);
v4l2_async_unregister_subdev(sd);
v4l2_subdev_cleanup(sd);
media_entity_cleanup(&sd->entity);
v4l2_ctrl_handler_free(sd->ctrl_handler);
pm_runtime_disable(imx355->dev);
if (!pm_runtime_status_suspended(imx355->dev)) {
imx355_power_off(imx355->dev);
pm_runtime_set_suspended(imx355->dev);
}
pm_runtime_dont_use_autosuspend(imx355->dev);
}
static const struct acpi_device_id imx355_acpi_ids[] __maybe_unused = {
{ "SONY355A" },
{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(acpi, imx355_acpi_ids);
static const struct of_device_id imx355_match_table[] = {
{ .compatible = "sony,imx355", },
{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, imx355_match_table);
static struct i2c_driver imx355_i2c_driver = {
.driver = {
.name = "imx355",
.acpi_match_table = ACPI_PTR(imx355_acpi_ids),
.of_match_table = imx355_match_table,
.pm = &imx355_pm_ops,
},
.probe = imx355_probe,
.remove = imx355_remove,
};
module_i2c_driver(imx355_i2c_driver);
MODULE_AUTHOR("Qiu, Tianshu <tian.shu.qiu@intel.com>");
MODULE_AUTHOR("Rapolu, Chiranjeevi");
MODULE_AUTHOR("Bingbu Cao <bingbu.cao@intel.com>");
MODULE_AUTHOR("Yang, Hyungwoo");
MODULE_DESCRIPTION("Sony imx355 sensor driver");
MODULE_LICENSE("GPL v2");