shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-06-07 11:26:02 +09:00
Code Issues Packages Projects Releases Wiki Activity

media: i2c: imx334 parse mclk pinctrl or the mclk will be unavailable

Browse Source 
and add set flip ctrl

Signed-off-by: Yiqing Zeng <zack.zeng@rock-chips.com>
Change-Id: I2c355c87ab7fe1e7e8f747e58efe499998e89c34
This commit is contained in:
Yiqing Zeng
2020-09-16 10:47:11 +08:00
committed by Tao Huang
parent 6100664ca6
commit ecf8977f0b
1 changed files with 61 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

63
drivers/media/i2c/imx334.c
View File

@@ -4,6 +4,9 @@
*
* Copyright (C) 2020 Rockchip Electronics Co., Ltd.
* V0.0X01.0X03 add enum_frame_interval function.
* V0.0X01.0X04
* 1.add parse mclk pinctrl.
* 2.add set flip ctrl.
*/
#include <linux/clk.h>
@@ -32,7 +35,7 @@
#include <linux/mfd/syscon.h>
#include <linux/rk-preisp.h>
#define DRIVER_VERSION KERNEL_VERSION(0, 0x01, 0x03)
#define DRIVER_VERSION KERNEL_VERSION(0, 0x01, 0x04)
#ifndef V4L2_CID_DIGITAL_GAIN
#define V4L2_CID_DIGITAL_GAIN V4L2_CID_GAIN
@@ -105,6 +108,9 @@
#define IMX334_FETCH_VTS_M(VAL) (((VAL) >> 8) & 0xFF)
#define IMX334_FETCH_VTS_L(VAL) ((VAL) & 0xFF)
#define IMX334_VREVERSE_REG 0x304f
#define IMX334_HREVERSE_REG 0x304e
#define REG_DELAY 0xFFFE
#define REG_NULL 0xFFFF
@@ -113,6 +119,8 @@
#define IMX334_REG_VALUE_24BIT 3
#define OF_CAMERA_HDR_MODE "rockchip,camera-hdr-mode"
#define OF_CAMERA_PINCTRL_STATE_DEFAULT "rockchip,camera_default"
#define OF_CAMERA_PINCTRL_STATE_SLEEP "rockchip,camera_sleep"
#define IMX334_NAME "imx334"
@@ -1284,6 +1292,13 @@ static int __imx334_power_on(struct imx334 *imx334)
s64 vclk_freq;
struct device *dev = &imx334->client->dev;
if (!IS_ERR_OR_NULL(imx334->pins_default)) {
ret = pinctrl_select_state(imx334->pinctrl,
imx334->pins_default);
if (ret < 0)
dev_err(dev, "could not set pins\n");
}
if (imx334->cur_mode->vclk_freq == IMX334_XVCLK_FREQ_37)
vclk_freq = IMX334_XVCLK_FREQ_37;
else
@@ -1467,6 +1482,7 @@ static int imx334_set_ctrl(struct v4l2_ctrl *ctrl)
int ret = 0;
u32 shr0 = 0;
u32 vts = 0;
u32 flip = 0;
/* Propagate change of current control to all related controls */
switch (ctrl->id) {
@@ -1534,6 +1550,28 @@ static int imx334_set_ctrl(struct v4l2_ctrl *ctrl)
case V4L2_CID_TEST_PATTERN:
ret = imx334_enable_test_pattern(imx334, ctrl->val);
break;
case V4L2_CID_HFLIP:
ret = imx334_write_reg(imx334->client, IMX334_HREVERSE_REG,
IMX334_REG_VALUE_08BIT, !!ctrl->val);
break;
case V4L2_CID_VFLIP:
flip = ctrl->val;
if (flip) {
ret = imx334_write_reg(imx334->client, IMX334_VREVERSE_REG,
IMX334_REG_VALUE_08BIT, !!flip);
ret |= imx334_write_reg(imx334->client, 0x3080,
IMX334_REG_VALUE_08BIT, 0xfe);
ret |= imx334_write_reg(imx334->client, 0x309b,
IMX334_REG_VALUE_08BIT, 0xfe);
} else {
ret = imx334_write_reg(imx334->client, IMX334_VREVERSE_REG,
IMX334_REG_VALUE_08BIT, !!flip);
ret |= imx334_write_reg(imx334->client, 0x3080,
IMX334_REG_VALUE_08BIT, 0x02);
ret |= imx334_write_reg(imx334->client, 0x309b,
IMX334_REG_VALUE_08BIT, 0x02);
}
break;
default:
dev_warn(&client->dev, "%s Unhandled id:0x%x, val:0x%x\n",
__func__, ctrl->id, ctrl->val);
@@ -1560,7 +1598,7 @@ static int imx334_initialize_controls(struct imx334 *imx334)
handler = &imx334->ctrl_handler;
mode = imx334->cur_mode;
ret = v4l2_ctrl_handler_init(handler, 8);
ret = v4l2_ctrl_handler_init(handler, 9);
if (ret)
return ret;
handler->lock = &imx334->mutex;
@@ -1613,6 +1651,10 @@ static int imx334_initialize_controls(struct imx334 *imx334)
V4L2_CID_TEST_PATTERN,
ARRAY_SIZE(imx334_test_pattern_menu) - 1,
0, 0, imx334_test_pattern_menu);
v4l2_ctrl_new_std(handler, &imx334_ctrl_ops, V4L2_CID_HFLIP, 0, 1, 1, 0);
v4l2_ctrl_new_std(handler, &imx334_ctrl_ops, V4L2_CID_VFLIP, 0, 1, 1, 0);
if (handler->error) {
ret = handler->error;
dev_err(&imx334->client->dev,
@@ -1725,6 +1767,23 @@ static int imx334_probe(struct i2c_client *client,
if (IS_ERR(imx334->pwdn_gpio))
dev_warn(dev, "Failed to get pwdn-gpios\n");
imx334->pinctrl = devm_pinctrl_get(dev);
if (!IS_ERR(imx334->pinctrl)) {
imx334->pins_default =
pinctrl_lookup_state(imx334->pinctrl,
OF_CAMERA_PINCTRL_STATE_DEFAULT);
if (IS_ERR(imx334->pins_default))
dev_info(dev, "could not get default pinstate\n");
imx334->pins_sleep =
pinctrl_lookup_state(imx334->pinctrl,
OF_CAMERA_PINCTRL_STATE_SLEEP);
if (IS_ERR(imx334->pins_sleep))
dev_info(dev, "could not get sleep pinstate\n");
} else {
dev_info(dev, "no pinctrl\n");
}
ret = imx334_configure_regulators(imx334);
if (ret) {
dev_err(dev, "Failed to get power regulators\n");