Lines Matching full:imx214
3 * imx214.c - imx214 sensor driver
36 struct imx214 { struct
427 static inline struct imx214 *to_imx214(struct v4l2_subdev *sd) in to_imx214()
429 return container_of(sd, struct imx214, sd); in to_imx214()
436 struct imx214 *imx214 = to_imx214(sd); in imx214_power_on() local
439 ret = regulator_bulk_enable(IMX214_NUM_SUPPLIES, imx214->supplies); in imx214_power_on()
441 dev_err(imx214->dev, "failed to enable regulators: %d\n", ret); in imx214_power_on()
447 ret = clk_prepare_enable(imx214->xclk); in imx214_power_on()
449 regulator_bulk_disable(IMX214_NUM_SUPPLIES, imx214->supplies); in imx214_power_on()
450 dev_err(imx214->dev, "clk prepare enable failed\n"); in imx214_power_on()
454 gpiod_set_value_cansleep(imx214->enable_gpio, 1); in imx214_power_on()
464 struct imx214 *imx214 = to_imx214(sd); in imx214_power_off() local
466 gpiod_set_value_cansleep(imx214->enable_gpio, 0); in imx214_power_off()
468 clk_disable_unprepare(imx214->xclk); in imx214_power_off()
470 regulator_bulk_disable(IMX214_NUM_SUPPLIES, imx214->supplies); in imx214_power_off()
508 struct imx214 *imx214 = container_of(subdev, struct imx214, sd); in imx214_s_register() local
510 return regmap_write(imx214->regmap, reg->reg, reg->val); in imx214_s_register()
516 struct imx214 *imx214 = container_of(subdev, struct imx214, sd); in imx214_g_register() local
521 ret = regmap_read(imx214->regmap, reg->reg, &aux); in imx214_g_register()
536 __imx214_get_pad_format(struct imx214 *imx214, in __imx214_get_pad_format() argument
543 return v4l2_subdev_get_try_format(&imx214->sd, sd_state, pad); in __imx214_get_pad_format()
545 return &imx214->fmt; in __imx214_get_pad_format()
555 struct imx214 *imx214 = to_imx214(sd); in imx214_get_format() local
557 mutex_lock(&imx214->mutex); in imx214_get_format()
558 format->format = *__imx214_get_pad_format(imx214, sd_state, in imx214_get_format()
561 mutex_unlock(&imx214->mutex); in imx214_get_format()
567 __imx214_get_pad_crop(struct imx214 *imx214, in __imx214_get_pad_crop() argument
573 return v4l2_subdev_get_try_crop(&imx214->sd, sd_state, pad); in __imx214_get_pad_crop()
575 return &imx214->crop; in __imx214_get_pad_crop()
585 struct imx214 *imx214 = to_imx214(sd); in imx214_set_format() local
590 mutex_lock(&imx214->mutex); in imx214_set_format()
592 __crop = __imx214_get_pad_crop(imx214, sd_state, format->pad, in imx214_set_format()
603 __format = __imx214_get_pad_format(imx214, sd_state, format->pad, in imx214_set_format()
617 mutex_unlock(&imx214->mutex); in imx214_set_format()
626 struct imx214 *imx214 = to_imx214(sd); in imx214_get_selection() local
631 mutex_lock(&imx214->mutex); in imx214_get_selection()
632 sel->r = *__imx214_get_pad_crop(imx214, sd_state, sel->pad, in imx214_get_selection()
634 mutex_unlock(&imx214->mutex); in imx214_get_selection()
654 struct imx214 *imx214 = container_of(ctrl->handler, in imx214_set_ctrl() local
655 struct imx214, ctrls); in imx214_set_ctrl()
663 if (!pm_runtime_get_if_in_use(imx214->dev)) in imx214_set_ctrl()
670 ret = regmap_bulk_write(imx214->regmap, 0x202, vals, 2); in imx214_set_ctrl()
672 dev_err(imx214->dev, "Error %d\n", ret); in imx214_set_ctrl()
680 pm_runtime_put(imx214->dev); in imx214_set_ctrl()
690 static int imx214_write_table(struct imx214 *imx214, in imx214_write_table() argument
710 ret = regmap_bulk_write(imx214->regmap, table->addr, vals, i); in imx214_write_table()
713 dev_err(imx214->dev, "write_table error: %d\n", ret); in imx214_write_table()
723 static int imx214_start_streaming(struct imx214 *imx214) in imx214_start_streaming() argument
728 mutex_lock(&imx214->mutex); in imx214_start_streaming()
729 ret = imx214_write_table(imx214, mode_table_common); in imx214_start_streaming()
731 dev_err(imx214->dev, "could not sent common table %d\n", ret); in imx214_start_streaming()
737 imx214->fmt.width, imx214->fmt.height); in imx214_start_streaming()
738 ret = imx214_write_table(imx214, mode->reg_table); in imx214_start_streaming()
740 dev_err(imx214->dev, "could not sent mode table %d\n", ret); in imx214_start_streaming()
743 ret = __v4l2_ctrl_handler_setup(&imx214->ctrls); in imx214_start_streaming()
745 dev_err(imx214->dev, "could not sync v4l2 controls\n"); in imx214_start_streaming()
748 ret = regmap_write(imx214->regmap, 0x100, 1); in imx214_start_streaming()
750 dev_err(imx214->dev, "could not sent start table %d\n", ret); in imx214_start_streaming()
754 mutex_unlock(&imx214->mutex); in imx214_start_streaming()
758 mutex_unlock(&imx214->mutex); in imx214_start_streaming()
762 static int imx214_stop_streaming(struct imx214 *imx214) in imx214_stop_streaming() argument
766 ret = regmap_write(imx214->regmap, 0x100, 0); in imx214_stop_streaming()
768 dev_err(imx214->dev, "could not sent stop table %d\n", ret); in imx214_stop_streaming()
775 struct imx214 *imx214 = to_imx214(subdev); in imx214_s_stream() local
778 if (imx214->streaming == enable) in imx214_s_stream()
782 ret = pm_runtime_resume_and_get(imx214->dev); in imx214_s_stream()
786 ret = imx214_start_streaming(imx214); in imx214_s_stream()
790 ret = imx214_stop_streaming(imx214); in imx214_s_stream()
793 pm_runtime_put(imx214->dev); in imx214_s_stream()
796 imx214->streaming = enable; in imx214_s_stream()
800 pm_runtime_put(imx214->dev); in imx214_s_stream()
863 static int imx214_get_regulators(struct device *dev, struct imx214 *imx214) in imx214_get_regulators() argument
868 imx214->supplies[i].supply = imx214_supply_name[i]; in imx214_get_regulators()
871 imx214->supplies); in imx214_get_regulators()
916 struct imx214 *imx214 = to_imx214(sd); in imx214_suspend() local
918 if (imx214->streaming) in imx214_suspend()
919 imx214_stop_streaming(imx214); in imx214_suspend()
928 struct imx214 *imx214 = to_imx214(sd); in imx214_resume() local
931 if (imx214->streaming) { in imx214_resume()
932 ret = imx214_start_streaming(imx214); in imx214_resume()
940 imx214_stop_streaming(imx214); in imx214_resume()
941 imx214->streaming = 0; in imx214_resume()
948 struct imx214 *imx214; in imx214_probe() local
962 imx214 = devm_kzalloc(dev, sizeof(*imx214), GFP_KERNEL); in imx214_probe()
963 if (!imx214) in imx214_probe()
966 imx214->dev = dev; in imx214_probe()
968 imx214->xclk = devm_clk_get(dev, NULL); in imx214_probe()
969 if (IS_ERR(imx214->xclk)) { in imx214_probe()
971 return PTR_ERR(imx214->xclk); in imx214_probe()
974 ret = clk_set_rate(imx214->xclk, IMX214_DEFAULT_CLK_FREQ); in imx214_probe()
980 ret = imx214_get_regulators(dev, imx214); in imx214_probe()
986 imx214->enable_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_LOW); in imx214_probe()
987 if (IS_ERR(imx214->enable_gpio)) { in imx214_probe()
989 return PTR_ERR(imx214->enable_gpio); in imx214_probe()
992 imx214->regmap = devm_regmap_init_i2c(client, &sensor_regmap_config); in imx214_probe()
993 if (IS_ERR(imx214->regmap)) { in imx214_probe()
995 return PTR_ERR(imx214->regmap); in imx214_probe()
998 v4l2_i2c_subdev_init(&imx214->sd, client, &imx214_subdev_ops); in imx214_probe()
1004 imx214_power_on(imx214->dev); in imx214_probe()
1006 pm_runtime_set_active(imx214->dev); in imx214_probe()
1007 pm_runtime_enable(imx214->dev); in imx214_probe()
1008 pm_runtime_idle(imx214->dev); in imx214_probe()
1010 v4l2_ctrl_handler_init(&imx214->ctrls, 3); in imx214_probe()
1012 imx214->pixel_rate = v4l2_ctrl_new_std(&imx214->ctrls, NULL, in imx214_probe()
1016 imx214->link_freq = v4l2_ctrl_new_int_menu(&imx214->ctrls, NULL, in imx214_probe()
1020 if (imx214->link_freq) in imx214_probe()
1021 imx214->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY; in imx214_probe()
1033 imx214->exposure = v4l2_ctrl_new_std(&imx214->ctrls, &imx214_ctrl_ops, in imx214_probe()
1037 imx214->unit_size = v4l2_ctrl_new_std_compound(&imx214->ctrls, in imx214_probe()
1041 ret = imx214->ctrls.error; in imx214_probe()
1048 imx214->sd.ctrl_handler = &imx214->ctrls; in imx214_probe()
1049 mutex_init(&imx214->mutex); in imx214_probe()
1050 imx214->ctrls.lock = &imx214->mutex; in imx214_probe()
1052 imx214->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; in imx214_probe()
1053 imx214->pad.flags = MEDIA_PAD_FL_SOURCE; in imx214_probe()
1054 imx214->sd.dev = &client->dev; in imx214_probe()
1055 imx214->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; in imx214_probe()
1057 ret = media_entity_pads_init(&imx214->sd.entity, 1, &imx214->pad); in imx214_probe()
1063 imx214_entity_init_cfg(&imx214->sd, NULL); in imx214_probe()
1065 ret = v4l2_async_register_subdev_sensor(&imx214->sd); in imx214_probe()
1074 media_entity_cleanup(&imx214->sd.entity); in imx214_probe()
1076 mutex_destroy(&imx214->mutex); in imx214_probe()
1077 v4l2_ctrl_handler_free(&imx214->ctrls); in imx214_probe()
1078 pm_runtime_disable(imx214->dev); in imx214_probe()
1086 struct imx214 *imx214 = to_imx214(sd); in imx214_remove() local
1088 v4l2_async_unregister_subdev(&imx214->sd); in imx214_remove()
1089 media_entity_cleanup(&imx214->sd.entity); in imx214_remove()
1090 v4l2_ctrl_handler_free(&imx214->ctrls); in imx214_remove()
1095 mutex_destroy(&imx214->mutex); in imx214_remove()
1099 { .compatible = "sony,imx214" },
1113 .name = "imx214",
1121 MODULE_DESCRIPTION("Sony IMX214 Camera driver");