imx219驱动与设备树代码.rar

/* * imx219.c - imx219 sensor driver * * Copyright (c) 2015-2016, NVIDIA CORPORATION. All rights reserved. * * This program is free software; you can redistribute it and/or modify it * under the terms and conditions of the GNU General Public License, * version 2, as published by the Free Software Foundation. * * This program is distributed in the hope it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see <http://www.gnu.org/licenses/>. */ #include <dt-bindings/gpio/tegra-gpio.h> #include <linux/slab.h> #include <linux/uaccess.h> #include <linux/gpio.h> #include <linux/module.h> #include <linux/seq_file.h> #include <linux/of.h> #include <linux/of_device.h> #include <linux/of_gpio.h> #include <media/camera_common.h> #include <media/soc_camera.h> #include <media/imx219.h> #include "imx219_mode_tbls.h" #define IMX219_MAX_COARSE_DIFF 4 #define IMX219_GAIN_SHIFT (8) #define IMX219_MIN_GAIN (1 << IMX219_GAIN_SHIFT) #define IMX219_MAX_GAIN (16 << IMX219_GAIN_SHIFT) #define IMX219_MIN_FRAME_LENGTH (0x0) #define IMX219_MAX_FRAME_LENGTH (0x7FFF) #define IMX219_MIN_EXPOSURE_COARSE (0x0001) #define IMX219_MAX_EXPOSURE_COARSE \ (IMX219_MAX_FRAME_LENGTH-IMX219_MAX_COARSE_DIFF) #define IMX219_DEFAULT_GAIN (IMX219_MIN_GAIN) #define IMX219_DEFAULT_FRAME_LENGTH (1766) #define IMX219_DEFAULT_EXPOSURE_COARSE \ (IMX219_DEFAULT_FRAME_LENGTH-IMX219_MAX_COARSE_DIFF) #define IMX219_DEFAULT_MODE IMX219_MODE_1920X1080 #define IMX219_DEFAULT_WIDTH 1920 #define IMX219_DEFAULT_HEIGHT 1080 #define IMX219_DEFAULT_DATAFMT MEDIA_BUS_FMT_SRGGB10_1X10 #define IMX219_DEFAULT_CLK_FREQ 24000000 struct imx219 { struct camera_common_power_rail power; int num_ctrls; struct v4l2_ctrl_handler ctrl_handler; struct i2c_client *i2c_client; struct v4l2_subdev *subdev; struct media_pad pad; struct regmap *regmap; struct camera_common_data *s_data; struct camera_common_pdata *pdata; struct v4l2_ctrl *ctrls[]; }; static const struct regmap_config sensor_regmap_config = { .reg_bits = 16, .val_bits = 8, .cache_type = REGCACHE_RBTREE, }; static int imx219_g_volatile_ctrl(struct v4l2_ctrl *ctrl); static int imx219_s_ctrl(struct v4l2_ctrl *ctrl); static const struct v4l2_ctrl_ops imx219_ctrl_ops = { .g_volatile_ctrl = imx219_g_volatile_ctrl, .s_ctrl = imx219_s_ctrl, }; static struct v4l2_ctrl_config ctrl_config_list[] = { /* Do not change the name field for the controls! */ { .ops = &imx219_ctrl_ops, .id = V4L2_CID_GAIN, .name = "Gain", .type = V4L2_CTRL_TYPE_INTEGER, .flags = V4L2_CTRL_FLAG_SLIDER, .min = IMX219_MIN_GAIN, .max = IMX219_MAX_GAIN, .def = IMX219_DEFAULT_GAIN, .step = 1, }, { .ops = &imx219_ctrl_ops, .id = V4L2_CID_FRAME_LENGTH, .name = "Frame Length", .type = V4L2_CTRL_TYPE_INTEGER, .flags = V4L2_CTRL_FLAG_SLIDER, .min = IMX219_MIN_FRAME_LENGTH, .max = IMX219_MAX_FRAME_LENGTH, .def = IMX219_DEFAULT_FRAME_LENGTH, .step = 1, }, { .ops = &imx219_ctrl_ops, .id = V4L2_CID_COARSE_TIME, .name = "Coarse Time", .type = V4L2_CTRL_TYPE_INTEGER, .flags = V4L2_CTRL_FLAG_SLIDER, .min = IMX219_MIN_EXPOSURE_COARSE, .max = IMX219_MAX_EXPOSURE_COARSE, .def = IMX219_DEFAULT_EXPOSURE_COARSE, .step = 1, }, { .ops = &imx219_ctrl_ops, .id = V4L2_CID_GROUP_HOLD, .name = "Group Hold", .type = V4L2_CTRL_TYPE_INTEGER_MENU, .min = 0, .max = ARRAY_SIZE(switch_ctrl_qmenu) - 1, .menu_skip_mask = 0, .def = 0, .qmenu_int = switch_ctrl_qmenu, }, { .ops = &imx219_ctrl_ops, .id = V4L2_CID_HDR_EN, .name = "HDR enable", .type = V4L2_CTRL_TYPE_INTEGER_MENU, .min = 0, .max = ARRAY_SIZE(switch_ctrl_qmenu) - 1, .menu_skip_mask = 0, .def = 0, .qmenu_int = switch_ctrl_qmenu, }, { .ops = &imx219_ctrl_ops, .id = V4L2_CID_FUSE_ID, .name = "Fuse ID", .type = V4L2_CTRL_TYPE_STRING, .flags = V4L2_CTRL_FLAG_READ_ONLY, .min = 0, .max = IMX219_FUSE_ID_STR_SIZE, .step = 2, }, }; static inline void imx219_get_frame_length_regs(struct reg_8 *regs, u16 frame_length) { regs->addr = IMX219_FRAME_LENGTH_ADDR_MSB; regs->val = (frame_length >> 8) & 0xff; (regs + 1)->addr = IMX219_FRAME_LENGTH_ADDR_LSB; (regs + 1)->val = (frame_length) & 0xff; } static inline void imx219_get_coarse_time_regs(struct reg_8 *regs, u16 coarse_time) { regs->addr = IMX219_COARSE_TIME_ADDR_MSB; regs->val = (coarse_time >> 8) & 0xff; (regs + 1)->addr = IMX219_COARSE_TIME_ADDR_LSB; (regs + 1)->val = (coarse_time) & 0xff; } static inline void imx219_get_gain_reg(struct reg_8 *regs, u8 gain) { regs->addr = IMX219_GAIN_ADDR; regs->val = gain & 0xff; } static int test_mode; module_param(test_mode, int, 0644); static inline int imx219_read_reg(struct camera_common_data *s_data, u16 addr, u8 *val) { struct imx219 *priv = (struct imx219 *)s_data->priv; return regmap_read(priv->regmap, addr, (unsigned int *) val); } static int imx219_write_reg(struct camera_common_data *s_data, u16 addr, u8 val) { int err; struct imx219 *priv = (struct imx219 *)s_data->priv; err = regmap_write(priv->regmap, addr, val); if (err) pr_err("%s:i2c write failed, %x = %x\n", __func__, addr, val); return err; } static int imx219_write_table(struct imx219 *priv, const struct reg_8 table[]) { return regmap_util_write_table_8(priv->regmap, table, NULL, 0, IMX219_TABLE_WAIT_MS, IMX219_TABLE_END); } static void imx219_mclk_disable(struct camera_common_power_rail *pw) { clk_disable_unprepare(pw->mclk); } static void imx219_mclk_enable(struct camera_common_power_rail *pw) { clk_set_rate(pw->mclk, IMX219_DEFAULT_CLK_FREQ); clk_prepare_enable(pw->mclk); } static int imx219_power_on(struct camera_common_data *s_data) { //int err = 0; struct imx219 *priv = (struct imx219 *)s_data->priv; struct camera_common_power_rail *pw = &priv->power; dev_info(&priv->i2c_client->dev, "%s: power on\n", __func__); if (gpio_cansleep(pw->reset_gpio)) gpio_set_value_cansleep(pw->reset_gpio, 0); else gpio_set_value(pw->reset_gpio, 0); usleep_range(10, 20); /* if (pw->avdd) err = regulator_enable(pw->avdd); if (err) goto imx219_avdd_fail; if (pw->iovdd) err = regulator_enable(pw->iovdd); if (err) goto imx219_iovdd_fail; if (pw->dvdd) err = regulator_enable(pw->dvdd); if (err) goto imx219_dvdd_fail; */ //usleep_range(1, 2); usleep_range(10, 20); if (gpio_cansleep(pw->reset_gpio)) gpio_set_value_cansleep(pw->reset_gpio, 1); else gpio_set_value(pw->reset_gpio, 1); //usleep_range(1, 2); usleep_range(10, 20); imx219_mclk_enable(pw); /* Need to wait for t4 + t5 + t9 time as per the data sheet */ /* t4 - 200us, t5 - 6ms, t9 - 1.2ms */ usleep_range(7400, 7410); pw->state = SWITCH_ON; return 0; /* imx219_dvdd_fail: regulator_disable(pw->iovdd); imx219_iovdd_fail: regulator_disable(pw->avdd); imx219_avdd_fail: return -ENODEV; */ } static int imx219_power_off(struct camera_common_data *s_data) { struct imx219 *priv = (struct imx219 *)s_data->priv; struct camera_common_power_rail *pw = &priv->power; dev_info(&priv->i2c_client->dev, "%s: power off\n", __func__); usleep_range(1, 2); if (gpio_cansleep(pw->reset_gpio)) gpio_set_value_cansleep(pw->reset_gpio, 0); else gpio_set_value(pw->reset_gpio, 0); //usleep_range(1, 2); usleep_range(10, 20); /* if (pw->dvdd) regulator_disable(pw->dvdd); if (pw->iovdd) regulator_disable(pw->iovdd);