Lines Matching full:dsi

225 static void mtk_dsi_mask(struct mtk_dsi *dsi, u32 offset, u32 mask, u32 data)  in mtk_dsi_mask()  argument
227 u32 temp = readl(dsi->regs + offset); in mtk_dsi_mask()
229 writel((temp & ~mask) | (data & mask), dsi->regs + offset); in mtk_dsi_mask()
232 static void mtk_dsi_phy_timconfig(struct mtk_dsi *dsi) in mtk_dsi_phy_timconfig() argument
235 u32 data_rate_mhz = DIV_ROUND_UP(dsi->data_rate, 1000000); in mtk_dsi_phy_timconfig()
236 struct mtk_phy_timing *timing = &dsi->phy_timing; in mtk_dsi_phy_timconfig()
264 writel(timcon0, dsi->regs + DSI_PHY_TIMECON0); in mtk_dsi_phy_timconfig()
265 writel(timcon1, dsi->regs + DSI_PHY_TIMECON1); in mtk_dsi_phy_timconfig()
266 writel(timcon2, dsi->regs + DSI_PHY_TIMECON2); in mtk_dsi_phy_timconfig()
267 writel(timcon3, dsi->regs + DSI_PHY_TIMECON3); in mtk_dsi_phy_timconfig()
270 static void mtk_dsi_enable(struct mtk_dsi *dsi) in mtk_dsi_enable() argument
272 mtk_dsi_mask(dsi, DSI_CON_CTRL, DSI_EN, DSI_EN); in mtk_dsi_enable()
275 static void mtk_dsi_disable(struct mtk_dsi *dsi) in mtk_dsi_disable() argument
277 mtk_dsi_mask(dsi, DSI_CON_CTRL, DSI_EN, 0); in mtk_dsi_disable()
280 static void mtk_dsi_reset_engine(struct mtk_dsi *dsi) in mtk_dsi_reset_engine() argument
282 mtk_dsi_mask(dsi, DSI_CON_CTRL, DSI_RESET, DSI_RESET); in mtk_dsi_reset_engine()
283 mtk_dsi_mask(dsi, DSI_CON_CTRL, DSI_RESET, 0); in mtk_dsi_reset_engine()
286 static void mtk_dsi_reset_dphy(struct mtk_dsi *dsi) in mtk_dsi_reset_dphy() argument
288 mtk_dsi_mask(dsi, DSI_CON_CTRL, DPHY_RESET, DPHY_RESET); in mtk_dsi_reset_dphy()
289 mtk_dsi_mask(dsi, DSI_CON_CTRL, DPHY_RESET, 0); in mtk_dsi_reset_dphy()
292 static void mtk_dsi_clk_ulp_mode_enter(struct mtk_dsi *dsi) in mtk_dsi_clk_ulp_mode_enter() argument
294 mtk_dsi_mask(dsi, DSI_PHY_LCCON, LC_HS_TX_EN, 0); in mtk_dsi_clk_ulp_mode_enter()
295 mtk_dsi_mask(dsi, DSI_PHY_LCCON, LC_ULPM_EN, 0); in mtk_dsi_clk_ulp_mode_enter()
298 static void mtk_dsi_clk_ulp_mode_leave(struct mtk_dsi *dsi) in mtk_dsi_clk_ulp_mode_leave() argument
300 mtk_dsi_mask(dsi, DSI_PHY_LCCON, LC_ULPM_EN, 0); in mtk_dsi_clk_ulp_mode_leave()
301 mtk_dsi_mask(dsi, DSI_PHY_LCCON, LC_WAKEUP_EN, LC_WAKEUP_EN); in mtk_dsi_clk_ulp_mode_leave()
302 mtk_dsi_mask(dsi, DSI_PHY_LCCON, LC_WAKEUP_EN, 0); in mtk_dsi_clk_ulp_mode_leave()
305 static void mtk_dsi_lane0_ulp_mode_enter(struct mtk_dsi *dsi) in mtk_dsi_lane0_ulp_mode_enter() argument
307 mtk_dsi_mask(dsi, DSI_PHY_LD0CON, LD0_HS_TX_EN, 0); in mtk_dsi_lane0_ulp_mode_enter()
308 mtk_dsi_mask(dsi, DSI_PHY_LD0CON, LD0_ULPM_EN, 0); in mtk_dsi_lane0_ulp_mode_enter()
311 static void mtk_dsi_lane0_ulp_mode_leave(struct mtk_dsi *dsi) in mtk_dsi_lane0_ulp_mode_leave() argument
313 mtk_dsi_mask(dsi, DSI_PHY_LD0CON, LD0_ULPM_EN, 0); in mtk_dsi_lane0_ulp_mode_leave()
314 mtk_dsi_mask(dsi, DSI_PHY_LD0CON, LD0_WAKEUP_EN, LD0_WAKEUP_EN); in mtk_dsi_lane0_ulp_mode_leave()
315 mtk_dsi_mask(dsi, DSI_PHY_LD0CON, LD0_WAKEUP_EN, 0); in mtk_dsi_lane0_ulp_mode_leave()
318 static bool mtk_dsi_clk_hs_state(struct mtk_dsi *dsi) in mtk_dsi_clk_hs_state() argument
320 return readl(dsi->regs + DSI_PHY_LCCON) & LC_HS_TX_EN; in mtk_dsi_clk_hs_state()
323 static void mtk_dsi_clk_hs_mode(struct mtk_dsi *dsi, bool enter) in mtk_dsi_clk_hs_mode() argument
325 if (enter && !mtk_dsi_clk_hs_state(dsi)) in mtk_dsi_clk_hs_mode()
326 mtk_dsi_mask(dsi, DSI_PHY_LCCON, LC_HS_TX_EN, LC_HS_TX_EN); in mtk_dsi_clk_hs_mode()
327 else if (!enter && mtk_dsi_clk_hs_state(dsi)) in mtk_dsi_clk_hs_mode()
328 mtk_dsi_mask(dsi, DSI_PHY_LCCON, LC_HS_TX_EN, 0); in mtk_dsi_clk_hs_mode()
331 static void mtk_dsi_set_mode(struct mtk_dsi *dsi) in mtk_dsi_set_mode() argument
335 if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO) { in mtk_dsi_set_mode()
336 if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO_BURST) in mtk_dsi_set_mode()
338 else if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO_SYNC_PULSE) in mtk_dsi_set_mode()
344 writel(vid_mode, dsi->regs + DSI_MODE_CTRL); in mtk_dsi_set_mode()
347 static void mtk_dsi_set_vm_cmd(struct mtk_dsi *dsi) in mtk_dsi_set_vm_cmd() argument
349 mtk_dsi_mask(dsi, DSI_VM_CMD_CON, VM_CMD_EN, VM_CMD_EN); in mtk_dsi_set_vm_cmd()
350 mtk_dsi_mask(dsi, DSI_VM_CMD_CON, TS_VFP_EN, TS_VFP_EN); in mtk_dsi_set_vm_cmd()
353 static void mtk_dsi_ps_control_vact(struct mtk_dsi *dsi) in mtk_dsi_ps_control_vact() argument
355 struct videomode *vm = &dsi->vm; in mtk_dsi_ps_control_vact()
359 if (dsi->format == MIPI_DSI_FMT_RGB565) in mtk_dsi_ps_control_vact()
367 switch (dsi->format) { in mtk_dsi_ps_control_vact()
382 writel(vm->vactive, dsi->regs + DSI_VACT_NL); in mtk_dsi_ps_control_vact()
383 writel(ps_bpp_mode, dsi->regs + DSI_PSCTRL); in mtk_dsi_ps_control_vact()
384 writel(ps_wc, dsi->regs + DSI_HSTX_CKL_WC); in mtk_dsi_ps_control_vact()
387 static void mtk_dsi_rxtx_control(struct mtk_dsi *dsi) in mtk_dsi_rxtx_control() argument
391 switch (dsi->lanes) { in mtk_dsi_rxtx_control()
409 if (dsi->mode_flags & MIPI_DSI_CLOCK_NON_CONTINUOUS) in mtk_dsi_rxtx_control()
412 if (dsi->mode_flags & MIPI_DSI_MODE_NO_EOT_PACKET) in mtk_dsi_rxtx_control()
415 writel(tmp_reg, dsi->regs + DSI_TXRX_CTRL); in mtk_dsi_rxtx_control()
418 static void mtk_dsi_ps_control(struct mtk_dsi *dsi) in mtk_dsi_ps_control() argument
423 switch (dsi->format) { in mtk_dsi_ps_control()
446 tmp_reg += dsi->vm.hactive * dsi_tmp_buf_bpp & DSI_PS_WC; in mtk_dsi_ps_control()
447 writel(tmp_reg, dsi->regs + DSI_PSCTRL); in mtk_dsi_ps_control()
450 static void mtk_dsi_config_vdo_timing(struct mtk_dsi *dsi) in mtk_dsi_config_vdo_timing() argument
459 struct mtk_phy_timing *timing = &dsi->phy_timing; in mtk_dsi_config_vdo_timing()
461 struct videomode *vm = &dsi->vm; in mtk_dsi_config_vdo_timing()
463 if (dsi->format == MIPI_DSI_FMT_RGB565) in mtk_dsi_config_vdo_timing()
468 writel(vm->vsync_len, dsi->regs + DSI_VSA_NL); in mtk_dsi_config_vdo_timing()
469 writel(vm->vback_porch, dsi->regs + DSI_VBP_NL); in mtk_dsi_config_vdo_timing()
470 writel(vm->vfront_porch, dsi->regs + DSI_VFP_NL); in mtk_dsi_config_vdo_timing()
471 writel(vm->vactive, dsi->regs + DSI_VACT_NL); in mtk_dsi_config_vdo_timing()
473 if (dsi->driver_data->has_size_ctl) in mtk_dsi_config_vdo_timing()
475 dsi->regs + DSI_SIZE_CON); in mtk_dsi_config_vdo_timing()
479 if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO_SYNC_PULSE) in mtk_dsi_config_vdo_timing()
488 delta = dsi->mode_flags & MIPI_DSI_MODE_VIDEO_BURST ? 18 : 12; in mtk_dsi_config_vdo_timing()
489 delta += dsi->mode_flags & MIPI_DSI_MODE_NO_EOT_PACKET ? 0 : 2; in mtk_dsi_config_vdo_timing()
493 data_phy_cycles_byte = data_phy_cycles * dsi->lanes + delta; in mtk_dsi_config_vdo_timing()
507 if ((dsi->mode_flags & MIPI_DSI_HS_PKT_END_ALIGNED) && in mtk_dsi_config_vdo_timing()
508 (dsi->lanes == 4)) { in mtk_dsi_config_vdo_timing()
510 roundup(horizontal_sync_active_byte, dsi->lanes) - 2; in mtk_dsi_config_vdo_timing()
512 roundup(horizontal_frontporch_byte, dsi->lanes) - 2; in mtk_dsi_config_vdo_timing()
514 roundup(horizontal_backporch_byte, dsi->lanes) - 2; in mtk_dsi_config_vdo_timing()
516 (vm->hactive * dsi_tmp_buf_bpp + 2) % dsi->lanes; in mtk_dsi_config_vdo_timing()
519 writel(horizontal_sync_active_byte, dsi->regs + DSI_HSA_WC); in mtk_dsi_config_vdo_timing()
520 writel(horizontal_backporch_byte, dsi->regs + DSI_HBP_WC); in mtk_dsi_config_vdo_timing()
521 writel(horizontal_frontporch_byte, dsi->regs + DSI_HFP_WC); in mtk_dsi_config_vdo_timing()
523 mtk_dsi_ps_control(dsi); in mtk_dsi_config_vdo_timing()
526 static void mtk_dsi_start(struct mtk_dsi *dsi) in mtk_dsi_start() argument
528 writel(0, dsi->regs + DSI_START); in mtk_dsi_start()
529 writel(1, dsi->regs + DSI_START); in mtk_dsi_start()
532 static void mtk_dsi_stop(struct mtk_dsi *dsi) in mtk_dsi_stop() argument
534 writel(0, dsi->regs + DSI_START); in mtk_dsi_stop()
537 static void mtk_dsi_set_cmd_mode(struct mtk_dsi *dsi) in mtk_dsi_set_cmd_mode() argument
539 writel(CMD_MODE, dsi->regs + DSI_MODE_CTRL); in mtk_dsi_set_cmd_mode()
542 static void mtk_dsi_set_interrupt_enable(struct mtk_dsi *dsi) in mtk_dsi_set_interrupt_enable() argument
546 writel(inten, dsi->regs + DSI_INTEN); in mtk_dsi_set_interrupt_enable()
549 static void mtk_dsi_irq_data_set(struct mtk_dsi *dsi, u32 irq_bit) in mtk_dsi_irq_data_set() argument
551 dsi->irq_data |= irq_bit; in mtk_dsi_irq_data_set()
554 static void mtk_dsi_irq_data_clear(struct mtk_dsi *dsi, u32 irq_bit) in mtk_dsi_irq_data_clear() argument
556 dsi->irq_data &= ~irq_bit; in mtk_dsi_irq_data_clear()
559 static s32 mtk_dsi_wait_for_irq_done(struct mtk_dsi *dsi, u32 irq_flag, in mtk_dsi_wait_for_irq_done() argument
565 ret = wait_event_interruptible_timeout(dsi->irq_wait_queue, in mtk_dsi_wait_for_irq_done()
566 dsi->irq_data & irq_flag, in mtk_dsi_wait_for_irq_done()
569 DRM_WARN("Wait DSI IRQ(0x%08x) Timeout\n", irq_flag); in mtk_dsi_wait_for_irq_done()
571 mtk_dsi_enable(dsi); in mtk_dsi_wait_for_irq_done()
572 mtk_dsi_reset_engine(dsi); in mtk_dsi_wait_for_irq_done()
580 struct mtk_dsi *dsi = dev_id; in mtk_dsi_irq() local
584 status = readl(dsi->regs + DSI_INTSTA) & flag; in mtk_dsi_irq()
588 mtk_dsi_mask(dsi, DSI_RACK, RACK, RACK); in mtk_dsi_irq()
589 tmp = readl(dsi->regs + DSI_INTSTA); in mtk_dsi_irq()
592 mtk_dsi_mask(dsi, DSI_INTSTA, status, 0); in mtk_dsi_irq()
593 mtk_dsi_irq_data_set(dsi, status); in mtk_dsi_irq()
594 wake_up_interruptible(&dsi->irq_wait_queue); in mtk_dsi_irq()
600 static s32 mtk_dsi_switch_to_cmd_mode(struct mtk_dsi *dsi, u8 irq_flag, u32 t) in mtk_dsi_switch_to_cmd_mode() argument
602 mtk_dsi_irq_data_clear(dsi, irq_flag); in mtk_dsi_switch_to_cmd_mode()
603 mtk_dsi_set_cmd_mode(dsi); in mtk_dsi_switch_to_cmd_mode()
605 if (!mtk_dsi_wait_for_irq_done(dsi, irq_flag, t)) { in mtk_dsi_switch_to_cmd_mode()
613 static int mtk_dsi_poweron(struct mtk_dsi *dsi) in mtk_dsi_poweron() argument
615 struct device *dev = dsi->host.dev; in mtk_dsi_poweron()
619 if (++dsi->refcount != 1) in mtk_dsi_poweron()
622 switch (dsi->format) { in mtk_dsi_poweron()
636 dsi->data_rate = DIV_ROUND_UP_ULL(dsi->vm.pixelclock * bit_per_pixel, in mtk_dsi_poweron()
637 dsi->lanes); in mtk_dsi_poweron()
639 ret = clk_set_rate(dsi->hs_clk, dsi->data_rate); in mtk_dsi_poweron()
645 phy_power_on(dsi->phy); in mtk_dsi_poweron()
647 ret = clk_prepare_enable(dsi->engine_clk); in mtk_dsi_poweron()
653 ret = clk_prepare_enable(dsi->digital_clk); in mtk_dsi_poweron()
659 mtk_dsi_enable(dsi); in mtk_dsi_poweron()
661 if (dsi->driver_data->has_shadow_ctl) in mtk_dsi_poweron()
663 dsi->regs + DSI_SHADOW_DEBUG); in mtk_dsi_poweron()
665 mtk_dsi_reset_engine(dsi); in mtk_dsi_poweron()
666 mtk_dsi_phy_timconfig(dsi); in mtk_dsi_poweron()
668 mtk_dsi_ps_control_vact(dsi); in mtk_dsi_poweron()
669 mtk_dsi_set_vm_cmd(dsi); in mtk_dsi_poweron()
670 mtk_dsi_config_vdo_timing(dsi); in mtk_dsi_poweron()
671 mtk_dsi_set_interrupt_enable(dsi); in mtk_dsi_poweron()
675 clk_disable_unprepare(dsi->engine_clk); in mtk_dsi_poweron()
677 phy_power_off(dsi->phy); in mtk_dsi_poweron()
679 dsi->refcount--; in mtk_dsi_poweron()
683 static void mtk_dsi_poweroff(struct mtk_dsi *dsi) in mtk_dsi_poweroff() argument
685 if (WARN_ON(dsi->refcount == 0)) in mtk_dsi_poweroff()
688 if (--dsi->refcount != 0) in mtk_dsi_poweroff()
696 * after dsi is fully set. in mtk_dsi_poweroff()
698 mtk_dsi_stop(dsi); in mtk_dsi_poweroff()
700 mtk_dsi_switch_to_cmd_mode(dsi, VM_DONE_INT_FLAG, 500); in mtk_dsi_poweroff()
701 mtk_dsi_reset_engine(dsi); in mtk_dsi_poweroff()
702 mtk_dsi_lane0_ulp_mode_enter(dsi); in mtk_dsi_poweroff()
703 mtk_dsi_clk_ulp_mode_enter(dsi); in mtk_dsi_poweroff()
705 writel(0, dsi->regs + DSI_TXRX_CTRL); in mtk_dsi_poweroff()
707 mtk_dsi_disable(dsi); in mtk_dsi_poweroff()
709 clk_disable_unprepare(dsi->engine_clk); in mtk_dsi_poweroff()
710 clk_disable_unprepare(dsi->digital_clk); in mtk_dsi_poweroff()
712 phy_power_off(dsi->phy); in mtk_dsi_poweroff()
714 dsi->lanes_ready = false; in mtk_dsi_poweroff()
717 static void mtk_dsi_lane_ready(struct mtk_dsi *dsi) in mtk_dsi_lane_ready() argument
719 if (!dsi->lanes_ready) { in mtk_dsi_lane_ready()
720 dsi->lanes_ready = true; in mtk_dsi_lane_ready()
721 mtk_dsi_rxtx_control(dsi); in mtk_dsi_lane_ready()
723 mtk_dsi_reset_dphy(dsi); in mtk_dsi_lane_ready()
724 mtk_dsi_clk_ulp_mode_leave(dsi); in mtk_dsi_lane_ready()
725 mtk_dsi_lane0_ulp_mode_leave(dsi); in mtk_dsi_lane_ready()
726 mtk_dsi_clk_hs_mode(dsi, 0); in mtk_dsi_lane_ready()
732 static void mtk_output_dsi_enable(struct mtk_dsi *dsi) in mtk_output_dsi_enable() argument
734 if (dsi->enabled) in mtk_output_dsi_enable()
737 mtk_dsi_lane_ready(dsi); in mtk_output_dsi_enable()
738 mtk_dsi_set_mode(dsi); in mtk_output_dsi_enable()
739 mtk_dsi_clk_hs_mode(dsi, 1); in mtk_output_dsi_enable()
741 mtk_dsi_start(dsi); in mtk_output_dsi_enable()
743 dsi->enabled = true; in mtk_output_dsi_enable()
746 static void mtk_output_dsi_disable(struct mtk_dsi *dsi) in mtk_output_dsi_disable() argument
748 if (!dsi->enabled) in mtk_output_dsi_disable()
751 dsi->enabled = false; in mtk_output_dsi_disable()
757 struct mtk_dsi *dsi = bridge_to_dsi(bridge); in mtk_dsi_bridge_attach() local
759 /* Attach the panel or bridge to the dsi bridge */ in mtk_dsi_bridge_attach()
760 return drm_bridge_attach(bridge->encoder, dsi->next_bridge, in mtk_dsi_bridge_attach()
761 &dsi->bridge, flags); in mtk_dsi_bridge_attach()
768 struct mtk_dsi *dsi = bridge_to_dsi(bridge); in mtk_dsi_bridge_mode_set() local
770 drm_display_mode_to_videomode(adjusted, &dsi->vm); in mtk_dsi_bridge_mode_set()
776 struct mtk_dsi *dsi = bridge_to_dsi(bridge); in mtk_dsi_bridge_atomic_disable() local
778 mtk_output_dsi_disable(dsi); in mtk_dsi_bridge_atomic_disable()
784 struct mtk_dsi *dsi = bridge_to_dsi(bridge); in mtk_dsi_bridge_atomic_enable() local
786 if (dsi->refcount == 0) in mtk_dsi_bridge_atomic_enable()
789 mtk_output_dsi_enable(dsi); in mtk_dsi_bridge_atomic_enable()
795 struct mtk_dsi *dsi = bridge_to_dsi(bridge); in mtk_dsi_bridge_atomic_pre_enable() local
798 ret = mtk_dsi_poweron(dsi); in mtk_dsi_bridge_atomic_pre_enable()
800 DRM_ERROR("failed to power on dsi\n"); in mtk_dsi_bridge_atomic_pre_enable()
806 struct mtk_dsi *dsi = bridge_to_dsi(bridge); in mtk_dsi_bridge_atomic_post_disable() local
808 mtk_dsi_poweroff(dsi); in mtk_dsi_bridge_atomic_post_disable()
816 struct mtk_dsi *dsi = bridge_to_dsi(bridge); in mtk_dsi_bridge_mode_valid() local
819 if (dsi->format == MIPI_DSI_FMT_RGB565) in mtk_dsi_bridge_mode_valid()
824 if (mode->clock * bpp / dsi->lanes > 1500000) in mtk_dsi_bridge_mode_valid()
845 struct mtk_dsi *dsi = dev_get_drvdata(dev); in mtk_dsi_ddp_start() local
847 mtk_dsi_poweron(dsi); in mtk_dsi_ddp_start()
852 struct mtk_dsi *dsi = dev_get_drvdata(dev); in mtk_dsi_ddp_stop() local
854 mtk_dsi_poweroff(dsi); in mtk_dsi_ddp_stop()
857 static int mtk_dsi_encoder_init(struct drm_device *drm, struct mtk_dsi *dsi) in mtk_dsi_encoder_init() argument
861 ret = drm_simple_encoder_init(drm, &dsi->encoder, in mtk_dsi_encoder_init()
868 dsi->encoder.possible_crtcs = mtk_drm_find_possible_crtc_by_comp(drm, dsi->host.dev); in mtk_dsi_encoder_init()
870 ret = drm_bridge_attach(&dsi->encoder, &dsi->bridge, NULL, in mtk_dsi_encoder_init()
875 dsi->connector = drm_bridge_connector_init(drm, &dsi->encoder); in mtk_dsi_encoder_init()
876 if (IS_ERR(dsi->connector)) { in mtk_dsi_encoder_init()
878 ret = PTR_ERR(dsi->connector); in mtk_dsi_encoder_init()
881 drm_connector_attach_encoder(dsi->connector, &dsi->encoder); in mtk_dsi_encoder_init()
886 drm_encoder_cleanup(&dsi->encoder); in mtk_dsi_encoder_init()
892 struct mtk_dsi *dsi = dev_get_drvdata(dev); in mtk_dsi_encoder_index() local
893 unsigned int encoder_index = drm_encoder_index(&dsi->encoder); in mtk_dsi_encoder_index()
903 struct mtk_dsi *dsi = dev_get_drvdata(dev); in mtk_dsi_bind() local
905 ret = mtk_dsi_encoder_init(drm, dsi); in mtk_dsi_bind()
915 struct mtk_dsi *dsi = dev_get_drvdata(dev); in mtk_dsi_unbind() local
917 drm_encoder_cleanup(&dsi->encoder); in mtk_dsi_unbind()
928 struct mtk_dsi *dsi = host_to_dsi(host); in mtk_dsi_host_attach() local
932 dsi->lanes = device->lanes; in mtk_dsi_host_attach()
933 dsi->format = device->format; in mtk_dsi_host_attach()
934 dsi->mode_flags = device->mode_flags; in mtk_dsi_host_attach()
935 dsi->next_bridge = devm_drm_of_get_bridge(dev, dev->of_node, 0, 0); in mtk_dsi_host_attach()
936 if (IS_ERR(dsi->next_bridge)) in mtk_dsi_host_attach()
937 return PTR_ERR(dsi->next_bridge); in mtk_dsi_host_attach()
939 drm_bridge_add(&dsi->bridge); in mtk_dsi_host_attach()
944 drm_bridge_remove(&dsi->bridge); in mtk_dsi_host_attach()
954 struct mtk_dsi *dsi = host_to_dsi(host); in mtk_dsi_host_detach() local
957 drm_bridge_remove(&dsi->bridge); in mtk_dsi_host_detach()
961 static void mtk_dsi_wait_for_idle(struct mtk_dsi *dsi) in mtk_dsi_wait_for_idle() argument
966 ret = readl_poll_timeout(dsi->regs + DSI_INTSTA, val, !(val & DSI_BUSY), in mtk_dsi_wait_for_idle()
969 DRM_WARN("polling dsi wait not busy timeout!\n"); in mtk_dsi_wait_for_idle()
971 mtk_dsi_enable(dsi); in mtk_dsi_wait_for_idle()
972 mtk_dsi_reset_engine(dsi); in mtk_dsi_wait_for_idle()
999 static void mtk_dsi_cmdq(struct mtk_dsi *dsi, const struct mipi_dsi_msg *msg) in mtk_dsi_cmdq() argument
1004 u32 reg_cmdq_off = dsi->driver_data->reg_cmdq_off; in mtk_dsi_cmdq()
1024 mtk_dsi_mask(dsi, (reg_cmdq_off + cmdq_off + i) & (~0x3U), in mtk_dsi_cmdq()
1028 mtk_dsi_mask(dsi, reg_cmdq_off, cmdq_mask, reg_val); in mtk_dsi_cmdq()
1029 mtk_dsi_mask(dsi, DSI_CMDQ_SIZE, CMDQ_SIZE, cmdq_size); in mtk_dsi_cmdq()
1030 if (dsi->driver_data->cmdq_long_packet_ctl) { in mtk_dsi_cmdq()
1032 mtk_dsi_mask(dsi, DSI_CMDQ_SIZE, CMDQ_SIZE_SEL, CMDQ_SIZE_SEL); in mtk_dsi_cmdq()
1036 static ssize_t mtk_dsi_host_send_cmd(struct mtk_dsi *dsi, in mtk_dsi_host_send_cmd() argument
1039 mtk_dsi_wait_for_idle(dsi); in mtk_dsi_host_send_cmd()
1040 mtk_dsi_irq_data_clear(dsi, flag); in mtk_dsi_host_send_cmd()
1041 mtk_dsi_cmdq(dsi, msg); in mtk_dsi_host_send_cmd()
1042 mtk_dsi_start(dsi); in mtk_dsi_host_send_cmd()
1044 if (!mtk_dsi_wait_for_irq_done(dsi, flag, 2000)) in mtk_dsi_host_send_cmd()
1053 struct mtk_dsi *dsi = host_to_dsi(host); in mtk_dsi_host_transfer() local
1061 dsi_mode = readl(dsi->regs + DSI_MODE_CTRL); in mtk_dsi_host_transfer()
1063 mtk_dsi_stop(dsi); in mtk_dsi_host_transfer()
1064 ret = mtk_dsi_switch_to_cmd_mode(dsi, VM_DONE_INT_FLAG, 500); in mtk_dsi_host_transfer()
1072 mtk_dsi_lane_ready(dsi); in mtk_dsi_host_transfer()
1074 ret = mtk_dsi_host_send_cmd(dsi, msg, irq_flag); in mtk_dsi_host_transfer()
1084 DRM_ERROR("dsi receive buffer size may be NULL\n"); in mtk_dsi_host_transfer()
1090 *(read_data + i) = readb(dsi->regs + DSI_RX_DATA0 + i); in mtk_dsi_host_transfer()
1108 DRM_INFO("dsi get %d byte data from the panel address(0x%x)\n", in mtk_dsi_host_transfer()
1113 mtk_dsi_set_mode(dsi); in mtk_dsi_host_transfer()
1114 mtk_dsi_start(dsi); in mtk_dsi_host_transfer()
1128 struct mtk_dsi *dsi; in mtk_dsi_probe() local
1134 dsi = devm_kzalloc(dev, sizeof(*dsi), GFP_KERNEL); in mtk_dsi_probe()
1135 if (!dsi) in mtk_dsi_probe()
1138 dsi->host.ops = &mtk_dsi_ops; in mtk_dsi_probe()
1139 dsi->host.dev = dev; in mtk_dsi_probe()
1140 ret = mipi_dsi_host_register(&dsi->host); in mtk_dsi_probe()
1142 dev_err(dev, "failed to register DSI host: %d\n", ret); in mtk_dsi_probe()
1146 dsi->driver_data = of_device_get_match_data(dev); in mtk_dsi_probe()
1148 dsi->engine_clk = devm_clk_get(dev, "engine"); in mtk_dsi_probe()
1149 if (IS_ERR(dsi->engine_clk)) { in mtk_dsi_probe()
1150 ret = PTR_ERR(dsi->engine_clk); in mtk_dsi_probe()
1157 dsi->digital_clk = devm_clk_get(dev, "digital"); in mtk_dsi_probe()
1158 if (IS_ERR(dsi->digital_clk)) { in mtk_dsi_probe()
1159 ret = PTR_ERR(dsi->digital_clk); in mtk_dsi_probe()
1166 dsi->hs_clk = devm_clk_get(dev, "hs"); in mtk_dsi_probe()
1167 if (IS_ERR(dsi->hs_clk)) { in mtk_dsi_probe()
1168 ret = PTR_ERR(dsi->hs_clk); in mtk_dsi_probe()
1174 dsi->regs = devm_ioremap_resource(dev, regs); in mtk_dsi_probe()
1175 if (IS_ERR(dsi->regs)) { in mtk_dsi_probe()
1176 ret = PTR_ERR(dsi->regs); in mtk_dsi_probe()
1181 dsi->phy = devm_phy_get(dev, "dphy"); in mtk_dsi_probe()
1182 if (IS_ERR(dsi->phy)) { in mtk_dsi_probe()
1183 ret = PTR_ERR(dsi->phy); in mtk_dsi_probe()
1195 IRQF_TRIGGER_NONE, dev_name(&pdev->dev), dsi); in mtk_dsi_probe()
1197 dev_err(&pdev->dev, "failed to request mediatek dsi irq\n"); in mtk_dsi_probe()
1201 init_waitqueue_head(&dsi->irq_wait_queue); in mtk_dsi_probe()
1203 platform_set_drvdata(pdev, dsi); in mtk_dsi_probe()
1205 dsi->bridge.funcs = &mtk_dsi_bridge_funcs; in mtk_dsi_probe()
1206 dsi->bridge.of_node = dev->of_node; in mtk_dsi_probe()
1207 dsi->bridge.type = DRM_MODE_CONNECTOR_DSI; in mtk_dsi_probe()
1212 mipi_dsi_host_unregister(&dsi->host); in mtk_dsi_probe()
1218 struct mtk_dsi *dsi = platform_get_drvdata(pdev); in mtk_dsi_remove() local
1220 mtk_output_dsi_disable(dsi); in mtk_dsi_remove()
1221 mipi_dsi_host_unregister(&dsi->host); in mtk_dsi_remove()
1252 { .compatible = "mediatek,mt2701-dsi",
1254 { .compatible = "mediatek,mt8173-dsi",
1256 { .compatible = "mediatek,mt8183-dsi",
1258 { .compatible = "mediatek,mt8186-dsi",
1260 { .compatible = "mediatek,mt8188-dsi",
1270 .name = "mtk-dsi",