Lines Matching refs:csid
83 static int csid_set_clock_rates(struct csid_device *csid) in csid_set_clock_rates() argument
85 struct device *dev = csid->camss->dev; in csid_set_clock_rates()
91 fmt = csid_get_fmt_entry(csid->formats, csid->nformats, in csid_set_clock_rates()
92 csid->fmt[MSM_CSIPHY_PAD_SINK].code); in csid_set_clock_rates()
93 link_freq = camss_get_link_freq(&csid->subdev.entity, fmt->bpp, in csid_set_clock_rates()
94 csid->phy.lane_cnt); in csid_set_clock_rates()
98 for (i = 0; i < csid->nclocks; i++) { in csid_set_clock_rates()
99 struct camss_clock *clock = &csid->clock[i]; in csid_set_clock_rates()
154 struct csid_device *csid = v4l2_get_subdevdata(sd); in csid_set_power() local
155 struct device *dev = csid->camss->dev; in csid_set_power()
163 ret = regulator_enable(csid->vdda); in csid_set_power()
169 ret = csid_set_clock_rates(csid); in csid_set_power()
171 regulator_disable(csid->vdda); in csid_set_power()
176 ret = camss_enable_clocks(csid->nclocks, csid->clock, dev); in csid_set_power()
178 regulator_disable(csid->vdda); in csid_set_power()
183 enable_irq(csid->irq); in csid_set_power()
185 ret = csid->ops->reset(csid); in csid_set_power()
187 disable_irq(csid->irq); in csid_set_power()
188 camss_disable_clocks(csid->nclocks, csid->clock); in csid_set_power()
189 regulator_disable(csid->vdda); in csid_set_power()
194 csid->ops->hw_version(csid); in csid_set_power()
196 disable_irq(csid->irq); in csid_set_power()
197 camss_disable_clocks(csid->nclocks, csid->clock); in csid_set_power()
198 ret = regulator_disable(csid->vdda); in csid_set_power()
216 struct csid_device *csid = v4l2_get_subdevdata(sd); in csid_set_stream() local
220 ret = v4l2_ctrl_handler_setup(&csid->ctrls); in csid_set_stream()
222 dev_err(csid->camss->dev, in csid_set_stream()
227 if (!csid->testgen.enabled && in csid_set_stream()
228 !media_entity_remote_pad(&csid->pads[MSM_CSID_PAD_SINK])) in csid_set_stream()
232 csid->ops->configure_stream(csid, enable); in csid_set_stream()
247 __csid_get_format(struct csid_device *csid, in __csid_get_format() argument
253 return v4l2_subdev_get_try_format(&csid->subdev, sd_state, in __csid_get_format()
256 return &csid->fmt[pad]; in __csid_get_format()
267 static void csid_try_format(struct csid_device *csid, in csid_try_format() argument
279 for (i = 0; i < csid->nformats; i++) in csid_try_format()
280 if (fmt->code == csid->formats[i].code) in csid_try_format()
284 if (i >= csid->nformats) in csid_try_format()
296 if (csid->testgen_mode->cur.val == 0) { in csid_try_format()
301 *fmt = *__csid_get_format(csid, sd_state, in csid_try_format()
303 fmt->code = csid->ops->src_pad_code(csid, fmt->code, 0, code); in csid_try_format()
308 for (i = 0; i < csid->nformats; i++) in csid_try_format()
309 if (csid->formats[i].code == fmt->code) in csid_try_format()
313 if (i >= csid->nformats) in csid_try_format()
338 struct csid_device *csid = v4l2_get_subdevdata(sd); in csid_enum_mbus_code() local
341 if (code->index >= csid->nformats) in csid_enum_mbus_code()
344 code->code = csid->formats[code->index].code; in csid_enum_mbus_code()
346 if (csid->testgen_mode->cur.val == 0) { in csid_enum_mbus_code()
349 sink_fmt = __csid_get_format(csid, sd_state, in csid_enum_mbus_code()
353 code->code = csid->ops->src_pad_code(csid, sink_fmt->code, in csid_enum_mbus_code()
358 if (code->index >= csid->nformats) in csid_enum_mbus_code()
361 code->code = csid->formats[code->index].code; in csid_enum_mbus_code()
379 struct csid_device *csid = v4l2_get_subdevdata(sd); in csid_enum_frame_size() local
388 csid_try_format(csid, sd_state, fse->pad, &format, fse->which); in csid_enum_frame_size()
398 csid_try_format(csid, sd_state, fse->pad, &format, fse->which); in csid_enum_frame_size()
417 struct csid_device *csid = v4l2_get_subdevdata(sd); in csid_get_format() local
420 format = __csid_get_format(csid, sd_state, fmt->pad, fmt->which); in csid_get_format()
441 struct csid_device *csid = v4l2_get_subdevdata(sd); in csid_set_format() local
444 format = __csid_get_format(csid, sd_state, fmt->pad, fmt->which); in csid_set_format()
448 csid_try_format(csid, sd_state, fmt->pad, &fmt->format, fmt->which); in csid_set_format()
453 format = __csid_get_format(csid, sd_state, MSM_CSID_PAD_SRC, in csid_set_format()
457 csid_try_format(csid, sd_state, MSM_CSID_PAD_SRC, format, in csid_set_format()
496 static int csid_set_test_pattern(struct csid_device *csid, s32 value) in csid_set_test_pattern() argument
498 struct csid_testgen_config *tg = &csid->testgen; in csid_set_test_pattern()
501 if (value && media_entity_remote_pad(&csid->pads[MSM_CSID_PAD_SINK])) in csid_set_test_pattern()
506 return csid->ops->configure_testgen_pattern(csid, value); in csid_set_test_pattern()
517 struct csid_device *csid = container_of(ctrl->handler, in csid_s_ctrl() local
523 ret = csid_set_test_pattern(csid, ctrl->val); in csid_s_ctrl()
542 int msm_csid_subdev_init(struct camss *camss, struct csid_device *csid, in msm_csid_subdev_init() argument
551 csid->camss = camss; in msm_csid_subdev_init()
552 csid->id = id; in msm_csid_subdev_init()
555 csid->ops = &csid_ops_4_1; in msm_csid_subdev_init()
558 csid->ops = &csid_ops_4_7; in msm_csid_subdev_init()
560 csid->ops = &csid_ops_170; in msm_csid_subdev_init()
564 csid->ops->subdev_init(csid); in msm_csid_subdev_init()
568 csid->base = devm_platform_ioremap_resource_byname(pdev, res->reg[0]); in msm_csid_subdev_init()
569 if (IS_ERR(csid->base)) in msm_csid_subdev_init()
570 return PTR_ERR(csid->base); in msm_csid_subdev_init()
581 csid->irq = r->start; in msm_csid_subdev_init()
582 snprintf(csid->irq_name, sizeof(csid->irq_name), "%s_%s%d", in msm_csid_subdev_init()
583 dev_name(dev), MSM_CSID_NAME, csid->id); in msm_csid_subdev_init()
584 ret = devm_request_irq(dev, csid->irq, csid->ops->isr, in msm_csid_subdev_init()
586 csid->irq_name, csid); in msm_csid_subdev_init()
594 csid->nclocks = 0; in msm_csid_subdev_init()
595 while (res->clock[csid->nclocks]) in msm_csid_subdev_init()
596 csid->nclocks++; in msm_csid_subdev_init()
598 csid->clock = devm_kcalloc(dev, csid->nclocks, sizeof(*csid->clock), in msm_csid_subdev_init()
600 if (!csid->clock) in msm_csid_subdev_init()
603 for (i = 0; i < csid->nclocks; i++) { in msm_csid_subdev_init()
604 struct camss_clock *clock = &csid->clock[i]; in msm_csid_subdev_init()
634 csid->vdda = devm_regulator_get(dev, res->regulator[0]); in msm_csid_subdev_init()
635 if (IS_ERR(csid->vdda)) { in msm_csid_subdev_init()
637 return PTR_ERR(csid->vdda); in msm_csid_subdev_init()
640 init_completion(&csid->reset_complete); in msm_csid_subdev_init()
653 struct csid_device *csid = v4l2_get_subdevdata(sd); in msm_csid_get_csid_id() local
655 *id = csid->id; in msm_csid_get_csid_id()
695 struct csid_device *csid; in csid_link_setup() local
701 csid = v4l2_get_subdevdata(sd); in csid_link_setup()
705 if (csid->testgen_mode->cur.val != 0) in csid_link_setup()
716 csid->phy.csiphy_id = csiphy->id; in csid_link_setup()
719 csid->phy.lane_cnt = lane_cfg->num_data; in csid_link_setup()
720 csid->phy.lane_assign = csid_get_lane_assign(lane_cfg); in csid_link_setup()
725 csid_set_format(&csid->subdev, NULL, &format); in csid_link_setup()
770 int msm_csid_register_entity(struct csid_device *csid, in msm_csid_register_entity() argument
773 struct v4l2_subdev *sd = &csid->subdev; in msm_csid_register_entity()
774 struct media_pad *pads = csid->pads; in msm_csid_register_entity()
775 struct device *dev = csid->camss->dev; in msm_csid_register_entity()
783 MSM_CSID_NAME, csid->id); in msm_csid_register_entity()
784 v4l2_set_subdevdata(sd, csid); in msm_csid_register_entity()
786 ret = v4l2_ctrl_handler_init(&csid->ctrls, 1); in msm_csid_register_entity()
792 csid->testgen_mode = v4l2_ctrl_new_std_menu_items(&csid->ctrls, in msm_csid_register_entity()
794 csid->testgen.nmodes, 0, 0, in msm_csid_register_entity()
795 csid->testgen.modes); in msm_csid_register_entity()
797 if (csid->ctrls.error) { in msm_csid_register_entity()
798 dev_err(dev, "Failed to init ctrl: %d\n", csid->ctrls.error); in msm_csid_register_entity()
799 ret = csid->ctrls.error; in msm_csid_register_entity()
803 csid->subdev.ctrl_handler = &csid->ctrls; in msm_csid_register_entity()
833 v4l2_ctrl_handler_free(&csid->ctrls); in msm_csid_register_entity()
842 void msm_csid_unregister_entity(struct csid_device *csid) in msm_csid_unregister_entity() argument
844 v4l2_device_unregister_subdev(&csid->subdev); in msm_csid_unregister_entity()
845 media_entity_cleanup(&csid->subdev.entity); in msm_csid_unregister_entity()
846 v4l2_ctrl_handler_free(&csid->ctrls); in msm_csid_unregister_entity()