// SPDX-License-Identifier: GPL-2.0 // Copyright (c) 2019 Intel Corporation. #include <linux/unaligned.h>#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/pm_runtime.h>#include <linux/regulator/consumer.h>#include <media/v4l2-ctrls.h>#include <media/v4l2-device.h>#include <media/v4l2-fwnode.h>#define HI556_REG_VALUE_08BIT 1#define HI556_REG_VALUE_16BIT 2#define HI556_REG_VALUE_24BIT 3#define HI556_LINK_FREQ_437MHZ 437000000ULL#define HI556_MCLK 19200000#define HI556_DATA_LANES 2#define HI556_RGB_DEPTH 10#define HI556_REG_CHIP_ID 0x0f16#define HI556_CHIP_ID 0x0556#define HI556_REG_MODE_SELECT 0x0a00#define HI556_MODE_STANDBY 0x0000#define HI556_MODE_STREAMING 0x0100/* vertical-timings from sensor */ #define HI556_REG_FLL 0x0006#define HI556_FLL_30FPS 0x0814#define HI556_FLL_30FPS_MIN 0x0814#define HI556_FLL_MAX 0x7fff/* horizontal-timings from sensor */ #define HI556_REG_LLP 0x0008/* Exposure controls from sensor */ #define HI556_REG_EXPOSURE 0x0074#define HI556_EXPOSURE_MIN 6#define HI556_EXPOSURE_MAX_MARGIN 2#define HI556_EXPOSURE_STEP 1/* Analog gain controls from sensor */ #define HI556_REG_ANALOG_GAIN 0x0077#define HI556_ANAL_GAIN_MIN 0#define HI556_ANAL_GAIN_MAX 240#define HI556_ANAL_GAIN_STEP 1/* Digital gain controls from sensor */ #define HI556_REG_MWB_GR_GAIN 0x0078#define HI556_REG_MWB_GB_GAIN 0x007a#define HI556_REG_MWB_R_GAIN 0x007c#define HI556_REG_MWB_B_GAIN 0x007e#define HI556_DGTL_GAIN_MIN 0#define HI556_DGTL_GAIN_MAX 2048#define HI556_DGTL_GAIN_STEP 1#define HI556_DGTL_GAIN_DEFAULT 256/* Test Pattern Control */ #define HI556_REG_ISP 0X0a05#define HI556_REG_ISP_TPG_EN 0x01#define HI556_REG_TEST_PATTERN 0x0201/* HI556 native and active pixel array size. */ #define HI556_NATIVE_WIDTH 2592U#define HI556_NATIVE_HEIGHT 1944U#define HI556_PIXEL_ARRAY_LEFT 0U#define HI556_PIXEL_ARRAY_TOP 0U#define HI556_PIXEL_ARRAY_WIDTH 2592U#define HI556_PIXEL_ARRAY_HEIGHT 1944Uenum {struct hi556_reg {struct hi556_reg_list {const struct hi556_reg *regs;struct hi556_link_freq_config {const struct hi556_reg_list reg_list;struct hi556_mode {/* Frame width in pixels */ /* Frame height in pixels */ /* Analog crop rectangle. */ struct v4l2_rect crop;/* Horizontal timining size */ /* Default vertical timining size */ /* Min vertical timining size */ /* Link frequency needed for this resolution */ /* Sensor register settings for this resolution */ const struct hi556_reg_list reg_list;#define to_hi556(_sd) container_of(_sd, struct hi556, sd)//SENSOR_INITIALIZATION static const struct hi556_reg mipi_data_rate_874mbps[] = {static const struct hi556_reg mode_2592x1944_regs[] = {static const struct hi556_reg mode_2592x1444_regs[] = {static const struct hi556_reg mode_1296x972_regs[] = {static const struct hi556_reg mode_1296x722_regs[] = {static const char * const hi556_test_pattern_menu[] = {"Disabled" ,"Solid Colour" ,"100% Colour Bars" ,"Fade To Grey Colour Bars" ,"PN9" ,"Gradient Horizontal" ,"Gradient Vertical" ,"Check Board" ,"Slant Pattern" ,static const s64 link_freq_menu_items[] = {static const struct hi556_link_freq_config link_freq_configs[] = {static const struct hi556_mode supported_modes[] = {static const char * const hi556_supply_names[] = {"dovdd" , /* Digital I/O power */ "avdd" , /* Analog power */ "dvdd" , /* Digital core power */ struct hi556 {struct v4l2_subdev sd;struct media_pad pad;struct v4l2_ctrl_handler ctrl_handler;/* V4L2 Controls */ struct v4l2_ctrl *link_freq;struct v4l2_ctrl *pixel_rate;struct v4l2_ctrl *vblank;struct v4l2_ctrl *hblank;struct v4l2_ctrl *exposure;/* GPIOs, clocks, etc. */ struct gpio_desc *reset_gpio;struct clk *clk;struct regulator_bulk_data supplies[ARRAY_SIZE(hi556_supply_names)];/* Current mode */ const struct hi556_mode *cur_mode;/* To serialize asynchronous callbacks */ struct mutex mutex;/* True if the device has been identified */ bool identified;static u64 to_pixel_rate(u32 f_index)return pixel_rate;static int hi556_read_reg(struct hi556 *hi556, u16 reg, u16 len, u32 *val)struct i2c_client *client = v4l2_get_subdevdata(&hi556->sd);struct i2c_msg msgs[2];int ret;if (len > 4)return -EINVAL;sizeof (addr_buf);if (ret != ARRAY_SIZE(msgs))return -EIO;return 0;static int hi556_write_reg(struct hi556 *hi556, u16 reg, u16 len, u32 val)struct i2c_client *client = v4l2_get_subdevdata(&hi556->sd);if (len > 4)return -EINVAL;if (i2c_master_send(client, buf, len + 2) != len + 2)return -EIO;return 0;static int hi556_write_reg_list(struct hi556 *hi556,const struct hi556_reg_list *r_list)struct i2c_client *client = v4l2_get_subdevdata(&hi556->sd);unsigned int i;int ret;for (i = 0; i < r_list->num_of_regs; i++) {if (ret) {"failed to write reg 0x%4.4x. error = %d\n" ,return ret;return 0;static int hi556_update_digital_gain(struct hi556 *hi556, u32 d_gain)int ret;if (ret)return ret;if (ret)return ret;if (ret)return ret;return hi556_write_reg(hi556, HI556_REG_MWB_B_GAIN,static int hi556_test_pattern(struct hi556 *hi556, u32 pattern)int ret;if (ret)return ret;if (ret)return ret;return hi556_write_reg(hi556, HI556_REG_TEST_PATTERN,static int hi556_set_ctrl(struct v4l2_ctrl *ctrl)struct hi556 *hi556 = container_of(ctrl->handler,struct hi556, ctrl_handler);struct i2c_client *client = v4l2_get_subdevdata(&hi556->sd);int ret = 0;/* Propagate change of current control to all related controls */ if (ctrl->id == V4L2_CID_VBLANK) {/* Update max exposure while meeting expected vblanking */ /* V4L2 controls values will be applied only when power is already up */ if (!pm_runtime_get_if_in_use(&client->dev))return 0;switch (ctrl->id) {case V4L2_CID_ANALOGUE_GAIN:break ;case V4L2_CID_DIGITAL_GAIN:break ;case V4L2_CID_EXPOSURE:break ;case V4L2_CID_VBLANK:/* Update FLL that meets expected vertical blanking */ break ;case V4L2_CID_TEST_PATTERN:break ;default :break ;return ret;static const struct v4l2_ctrl_ops hi556_ctrl_ops = {static int hi556_init_controls(struct hi556 *hi556)struct v4l2_ctrl_handler *ctrl_hdlr;int ret;if (ret)return ret;if (hi556->link_freq)if (hi556->hblank)if (ctrl_hdlr->error)return ctrl_hdlr->error;return 0;static void hi556_assign_pad_format(const struct hi556_mode *mode,struct v4l2_mbus_framefmt *fmt)static int hi556_identify_module(struct hi556 *hi556)struct i2c_client *client = v4l2_get_subdevdata(&hi556->sd);int ret;if (hi556->identified)return 0;if (ret)return ret;if (val != HI556_CHIP_ID) {"chip id mismatch: %x!=%x\n" ,return -ENXIO;true ;return 0;static const struct v4l2_rect *struct hi556 *hi556,struct v4l2_subdev_state *sd_state,unsigned int pad, enum v4l2_subdev_format_whence which)switch (which) {case V4L2_SUBDEV_FORMAT_TRY:return v4l2_subdev_state_get_crop(sd_state, pad);case V4L2_SUBDEV_FORMAT_ACTIVE:return &hi556->cur_mode->crop;return NULL;static int hi556_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: {struct hi556 *hi556 = to_hi556(sd);return 0;case V4L2_SEL_TGT_NATIVE_SIZE:return 0;case V4L2_SEL_TGT_CROP_DEFAULT:case V4L2_SEL_TGT_CROP_BOUNDS:return 0;return -EINVAL;static int hi556_start_streaming(struct hi556 *hi556)struct i2c_client *client = v4l2_get_subdevdata(&hi556->sd);const struct hi556_reg_list *reg_list;int link_freq_index, ret;if (ret)return ret;if (ret) {"failed to set plls\n" );return ret;if (ret) {"failed to set mode\n" );return ret;if (ret)return ret;if (ret) {"failed to set stream\n" );return ret;return 0;static void hi556_stop_streaming(struct hi556 *hi556)struct i2c_client *client = v4l2_get_subdevdata(&hi556->sd);if (hi556_write_reg(hi556, HI556_REG_MODE_SELECT,"failed to set stream\n" );static int hi556_set_stream(struct v4l2_subdev *sd, int enable)struct hi556 *hi556 = to_hi556(sd);struct i2c_client *client = v4l2_get_subdevdata(sd);int ret = 0;if (enable) {if (ret < 0) {return ret;if (ret) {else {return ret;static int hi556_set_format(struct v4l2_subdev *sd,struct v4l2_subdev_state *sd_state,struct v4l2_subdev_format *fmt)struct hi556 *hi556 = to_hi556(sd);const struct hi556_mode *mode;if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {else {/* Update limits and set FPS to default */ return 0;static int hi556_get_format(struct v4l2_subdev *sd,struct v4l2_subdev_state *sd_state,struct v4l2_subdev_format *fmt)struct hi556 *hi556 = to_hi556(sd);if (fmt->which == V4L2_SUBDEV_FORMAT_TRY)else return 0;static int hi556_enum_mbus_code(struct v4l2_subdev *sd,struct v4l2_subdev_state *sd_state,struct v4l2_subdev_mbus_code_enum *code)if (code->index > 0)return -EINVAL;return 0;static int hi556_enum_frame_size(struct v4l2_subdev *sd,struct v4l2_subdev_state *sd_state,struct v4l2_subdev_frame_size_enum *fse)if (fse->index >= ARRAY_SIZE(supported_modes))return -EINVAL;if (fse->code != MEDIA_BUS_FMT_SGRBG10_1X10)return -EINVAL;return 0;static int hi556_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)struct hi556 *hi556 = to_hi556(sd);struct v4l2_rect *try_crop;/* Initialize try_crop rectangle. */ return 0;static const struct v4l2_subdev_video_ops hi556_video_ops = {static const struct v4l2_subdev_pad_ops hi556_pad_ops = {static const struct v4l2_subdev_ops hi556_subdev_ops = {static const struct media_entity_operations hi556_subdev_entity_ops = {static const struct v4l2_subdev_internal_ops hi556_internal_ops = {static int hi556_check_hwcfg(struct device *dev)struct fwnode_handle *ep;struct fwnode_handle *fwnode = dev_fwnode(dev);struct v4l2_fwnode_endpoint bus_cfg = {int ret = 0;unsigned int i, j;/* * Sometimes the fwnode graph is initialized by the bridge driver, * wait for this. if (!ep)return dev_err_probe(dev, -EPROBE_DEFER,"waiting for fwnode graph endpoint\n" );if (ret)return dev_err_probe(dev, ret, "parsing endpoint failed\n" );"clock-frequency" , &mclk);if (ret) {"can't get clock frequency\n" );goto check_hwcfg_error;if (mclk != HI556_MCLK) {"external clock %d is not supported\n" , mclk);goto check_hwcfg_error;if (bus_cfg.bus.mipi_csi2.num_data_lanes != 2) {"number of CSI2 data lanes %d is not supported\n" ,goto check_hwcfg_error;if (!bus_cfg.nr_of_link_frequencies) {"no link frequencies defined\n" );goto check_hwcfg_error;for (i = 0; i < ARRAY_SIZE(link_freq_menu_items); i++) {for (j = 0; j < bus_cfg.nr_of_link_frequencies; j++) {if (link_freq_menu_items[i] ==break ;if (j == bus_cfg.nr_of_link_frequencies) {"no link frequency %lld supported\n" ,goto check_hwcfg_error;return ret;static void hi556_remove(struct i2c_client *client)struct v4l2_subdev *sd = i2c_get_clientdata(client);struct hi556 *hi556 = to_hi556(sd);static int hi556_suspend(struct device *dev)struct v4l2_subdev *sd = dev_get_drvdata(dev);struct hi556 *hi556 = to_hi556(sd);return 0;static int hi556_resume(struct device *dev)struct v4l2_subdev *sd = dev_get_drvdata(dev);struct hi556 *hi556 = to_hi556(sd);int ret;if (ret)return ret;if (ret) {"failed to enable regulators: %d" , ret);return ret;if (hi556->reset_gpio) {/* Assert reset for at least 2ms on back to back off-on */ return 0;static int hi556_probe(struct i2c_client *client)struct hi556 *hi556;bool full_power;int i, ret;if (ret)return ret;sizeof (*hi556), GFP_KERNEL);if (!hi556)return -ENOMEM;"reset" ,if (IS_ERR(hi556->reset_gpio))return dev_err_probe(&client->dev, PTR_ERR(hi556->reset_gpio),"failed to get reset GPIO\n" );"clk" );if (IS_ERR(hi556->clk))return dev_err_probe(&client->dev, PTR_ERR(hi556->clk),"failed to get clock\n" );for (i = 0; i < ARRAY_SIZE(hi556_supply_names); i++)if (ret)return dev_err_probe(&client->dev, ret,"failed to get regulators\n" );if (full_power) {/* Ensure non ACPI managed resources are enabled */ if (ret)return dev_err_probe(&client->dev, ret,"failed to power on sensor\n" );if (ret) {"failed to find sensor: %d\n" , ret);goto probe_error_power_off;if (ret) {"failed to init controls: %d\n" , ret);goto probe_error_v4l2_ctrl_handler_free;if (ret) {"failed to init entity pads: %d\n" , ret);goto probe_error_v4l2_ctrl_handler_free;if (ret < 0) {"failed to register V4L2 subdev: %d\n" ,goto probe_error_media_entity_cleanup;/* Set the device's state to active if it's in D0 state. */ if (full_power)return 0;if (full_power)return ret;static DEFINE_RUNTIME_DEV_PM_OPS(hi556_pm_ops, hi556_suspend, hi556_resume,#ifdef CONFIG_ACPIstatic const struct acpi_device_id hi556_acpi_ids[] = {"INT3537" },#endif static struct i2c_driver hi556_i2c_driver = {"hi556" ,"Shawn Tu" );"Hynix HI556 sensor driver" );"GPL v2" );
Messung V0.5 C=96 H=94 G=94
¤ Dauer der Verarbeitung: 0.8 Sekunden
¤ *© Formatika GbR, Deutschland
