Lines Matching full:csi
4 * Intel Visual Sensing Controller CSI Linux driver
8 * To set ownership of CSI-2 link and to configure CSI-2 link, there
36 #define MEI_CSI_ENTITY_NAME "Intel IVSC CSI"
40 /* to setup CSI-2 link an extra delay needed and determined experimentally */
51 /* used to set csi ownership */
54 /* used to configure CSI-2 link */
61 /* CSI-2 link ownership definition */
80 /* configuration of the CSI-2 link between host and IVSC */
82 /* number of data lanes used on the CSI-2 link */
85 /* frequency of the CSI-2 link */
92 /* CSI command structure */
101 /* CSI notification structure */
134 /* number of data lanes used on the CSI-2 link */
136 /* frequency of the CSI-2 link */
158 static int mei_csi_send(struct mei_csi *csi, u8 *buf, size_t len) in mei_csi_send() argument
163 reinit_completion(&csi->cmd_completion); in mei_csi_send()
165 ret = mei_cldev_send(csi->cldev, buf, len); in mei_csi_send()
169 ret = wait_for_completion_killable_timeout(&csi->cmd_completion, in mei_csi_send()
179 ret = csi->cmd_response.status; in mei_csi_send()
183 v4l2_ctrl_s_ctrl(csi->privacy_ctrl, 1); in mei_csi_send()
189 if (csi->cmd_response.cmd_id != cmd->cmd_id) in mei_csi_send()
196 /* set CSI-2 link ownership */
197 static int csi_set_link_owner(struct mei_csi *csi, enum csi_link_owner owner) in csi_set_link_owner() argument
207 mutex_lock(&csi->lock); in csi_set_link_owner()
209 ret = mei_csi_send(csi, (u8 *)&cmd, cmd_size); in csi_set_link_owner()
211 mutex_unlock(&csi->lock); in csi_set_link_owner()
216 /* configure CSI-2 link between host and IVSC */
217 static int csi_set_link_cfg(struct mei_csi *csi) in csi_set_link_cfg() argument
224 cmd.param.conf.nr_of_lanes = csi->nr_of_lanes; in csi_set_link_cfg()
225 cmd.param.conf.link_freq = CSI_LINK_FREQ(csi->link_freq); in csi_set_link_cfg()
228 mutex_lock(&csi->lock); in csi_set_link_cfg()
230 ret = mei_csi_send(csi, (u8 *)&cmd, cmd_size); in csi_set_link_cfg()
239 mutex_unlock(&csi->lock); in csi_set_link_cfg()
247 struct mei_csi *csi = mei_cldev_get_drvdata(cldev); in mei_csi_rx() local
260 v4l2_ctrl_s_ctrl(csi->privacy_ctrl, in mei_csi_rx()
265 memcpy(&csi->cmd_response, ¬if, ret); in mei_csi_rx()
267 complete(&csi->cmd_completion); in mei_csi_rx()
276 struct mei_csi *csi = sd_to_csi(sd); in mei_csi_set_stream() local
278 media_entity_to_v4l2_subdev(csi->remote->entity); in mei_csi_set_stream()
282 if (enable && csi->streaming == 0) { in mei_csi_set_stream()
283 freq = v4l2_get_link_freq(csi->remote, 0, 0); in mei_csi_set_stream()
285 dev_err(&csi->cldev->dev, in mei_csi_set_stream()
290 csi->link_freq = freq; in mei_csi_set_stream()
292 /* switch CSI-2 link to host */ in mei_csi_set_stream()
293 ret = csi_set_link_owner(csi, CSI_LINK_HOST); in mei_csi_set_stream()
297 /* configure CSI-2 link */ in mei_csi_set_stream()
298 ret = csi_set_link_cfg(csi); in mei_csi_set_stream()
305 } else if (!enable && csi->streaming == 1) { in mei_csi_set_stream()
308 /* switch CSI-2 link to IVSC */ in mei_csi_set_stream()
309 ret = csi_set_link_owner(csi, CSI_LINK_IVSC); in mei_csi_set_stream()
311 dev_warn(&csi->cldev->dev, in mei_csi_set_stream()
315 csi->streaming = enable; in mei_csi_set_stream()
320 csi_set_link_owner(csi, CSI_LINK_IVSC); in mei_csi_set_stream()
466 struct mei_csi *csi = sd_to_csi(sd); in mei_csi_get_mbus_config() local
473 mbus_config->bus.mipi_csi2.num_data_lanes = csi->nr_of_lanes; in mei_csi_get_mbus_config()
475 freq = v4l2_get_link_freq(csi->remote, 0, 0); in mei_csi_get_mbus_config()
477 dev_err(&csi->cldev->dev, in mei_csi_get_mbus_config()
482 csi->link_freq = freq; in mei_csi_get_mbus_config()
515 struct mei_csi *csi = notifier_to_csi(notifier); in mei_csi_notify_bound() local
523 csi->remote = &subdev->entity.pads[pad]; in mei_csi_notify_bound()
526 &csi->subdev.entity, CSI_PAD_SINK, in mei_csi_notify_bound()
535 struct mei_csi *csi = notifier_to_csi(notifier); in mei_csi_notify_unbind() local
537 csi->remote = NULL; in mei_csi_notify_unbind()
545 static int mei_csi_init_controls(struct mei_csi *csi) in mei_csi_init_controls() argument
549 mutex_init(&csi->ctrl_lock); in mei_csi_init_controls()
551 ret = v4l2_ctrl_handler_init(&csi->ctrl_handler, 1); in mei_csi_init_controls()
555 csi->ctrl_handler.lock = &csi->ctrl_lock; in mei_csi_init_controls()
557 csi->privacy_ctrl = v4l2_ctrl_new_std(&csi->ctrl_handler, NULL, in mei_csi_init_controls()
559 if (csi->privacy_ctrl) in mei_csi_init_controls()
560 csi->privacy_ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY; in mei_csi_init_controls()
562 if (csi->ctrl_handler.error) in mei_csi_init_controls()
563 return csi->ctrl_handler.error; in mei_csi_init_controls()
565 csi->subdev.ctrl_handler = &csi->ctrl_handler; in mei_csi_init_controls()
570 static int mei_csi_parse_firmware(struct mei_csi *csi) in mei_csi_parse_firmware() argument
575 struct device *dev = &csi->cldev->dev; in mei_csi_parse_firmware()
586 v4l2_async_subdev_nf_init(&csi->notifier, &csi->subdev); in mei_csi_parse_firmware()
587 csi->notifier.ops = &mei_csi_notify_ops; in mei_csi_parse_firmware()
595 csi->nr_of_lanes = v4l2_ep.bus.mipi_csi2.num_data_lanes; in mei_csi_parse_firmware()
611 if (csi->nr_of_lanes != v4l2_ep.bus.mipi_csi2.num_data_lanes) { in mei_csi_parse_firmware()
615 csi->nr_of_lanes, v4l2_ep.bus.mipi_csi2.num_data_lanes); in mei_csi_parse_firmware()
619 asd = v4l2_async_nf_add_fwnode_remote(&csi->notifier, sink_ep, in mei_csi_parse_firmware()
626 ret = v4l2_async_nf_register(&csi->notifier); in mei_csi_parse_firmware()
635 v4l2_async_nf_cleanup(&csi->notifier); in mei_csi_parse_firmware()
646 struct mei_csi *csi; in mei_csi_probe() local
662 dev_err(dev, "mei-csi probed without device fwnode!\n"); in mei_csi_probe()
666 csi = devm_kzalloc(dev, sizeof(struct mei_csi), GFP_KERNEL); in mei_csi_probe()
667 if (!csi) in mei_csi_probe()
670 csi->cldev = cldev; in mei_csi_probe()
671 mutex_init(&csi->lock); in mei_csi_probe()
672 init_completion(&csi->cmd_completion); in mei_csi_probe()
674 mei_cldev_set_drvdata(cldev, csi); in mei_csi_probe()
688 ret = mei_csi_parse_firmware(csi); in mei_csi_probe()
692 csi->subdev.dev = &cldev->dev; in mei_csi_probe()
693 csi->subdev.state_lock = &csi->lock; in mei_csi_probe()
694 v4l2_subdev_init(&csi->subdev, &mei_csi_subdev_ops); in mei_csi_probe()
695 csi->subdev.internal_ops = &mei_csi_internal_ops; in mei_csi_probe()
696 v4l2_set_subdevdata(&csi->subdev, csi); in mei_csi_probe()
697 csi->subdev.flags = V4L2_SUBDEV_FL_HAS_DEVNODE | in mei_csi_probe()
699 csi->subdev.entity.function = MEDIA_ENT_F_VID_IF_BRIDGE; in mei_csi_probe()
700 csi->subdev.entity.ops = &mei_csi_entity_ops; in mei_csi_probe()
702 snprintf(csi->subdev.name, sizeof(csi->subdev.name), in mei_csi_probe()
705 ret = mei_csi_init_controls(csi); in mei_csi_probe()
709 csi->pads[CSI_PAD_SOURCE].flags = MEDIA_PAD_FL_SOURCE; in mei_csi_probe()
710 csi->pads[CSI_PAD_SINK].flags = MEDIA_PAD_FL_SINK; in mei_csi_probe()
711 ret = media_entity_pads_init(&csi->subdev.entity, CSI_NUM_PADS, in mei_csi_probe()
712 csi->pads); in mei_csi_probe()
716 ret = v4l2_subdev_init_finalize(&csi->subdev); in mei_csi_probe()
720 ret = v4l2_async_register_subdev(&csi->subdev); in mei_csi_probe()
729 v4l2_subdev_cleanup(&csi->subdev); in mei_csi_probe()
732 media_entity_cleanup(&csi->subdev.entity); in mei_csi_probe()
735 v4l2_ctrl_handler_free(&csi->ctrl_handler); in mei_csi_probe()
736 mutex_destroy(&csi->ctrl_lock); in mei_csi_probe()
737 v4l2_async_nf_unregister(&csi->notifier); in mei_csi_probe()
738 v4l2_async_nf_cleanup(&csi->notifier); in mei_csi_probe()
744 mutex_destroy(&csi->lock); in mei_csi_probe()
751 struct mei_csi *csi = mei_cldev_get_drvdata(cldev); in mei_csi_remove() local
753 v4l2_async_nf_unregister(&csi->notifier); in mei_csi_remove()
754 v4l2_async_nf_cleanup(&csi->notifier); in mei_csi_remove()
755 v4l2_ctrl_handler_free(&csi->ctrl_handler); in mei_csi_remove()
756 mutex_destroy(&csi->ctrl_lock); in mei_csi_remove()
757 v4l2_async_unregister_subdev(&csi->subdev); in mei_csi_remove()
758 v4l2_subdev_cleanup(&csi->subdev); in mei_csi_remove()
759 media_entity_cleanup(&csi->subdev.entity); in mei_csi_remove()
763 mutex_destroy(&csi->lock); in mei_csi_remove()
788 MODULE_DESCRIPTION("Device driver for IVSC CSI");