1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Copyright (C) 2016 BayLibre, SAS 4 * Author: Neil Armstrong <narmstrong@baylibre.com> 5 * Copyright (C) 2015 Amlogic, Inc. All rights reserved. 6 */ 7 8 #include <linux/kernel.h> 9 #include <linux/module.h> 10 #include <linux/of_graph.h> 11 12 #include <drm/drm_atomic_helper.h> 13 #include <drm/drm_simple_kms_helper.h> 14 #include <drm/drm_bridge.h> 15 #include <drm/drm_bridge_connector.h> 16 #include <drm/drm_device.h> 17 #include <drm/drm_probe_helper.h> 18 19 #include "meson_drv.h" 20 #include "meson_encoder_dsi.h" 21 #include "meson_registers.h" 22 #include "meson_venc.h" 23 #include "meson_vclk.h" 24 25 struct meson_encoder_dsi { 26 struct drm_encoder encoder; 27 struct drm_bridge bridge; 28 struct meson_drm *priv; 29 }; 30 31 #define bridge_to_meson_encoder_dsi(x) \ 32 container_of(x, struct meson_encoder_dsi, bridge) 33 34 static int meson_encoder_dsi_attach(struct drm_bridge *bridge, 35 struct drm_encoder *encoder, 36 enum drm_bridge_attach_flags flags) 37 { 38 struct meson_encoder_dsi *encoder_dsi = bridge_to_meson_encoder_dsi(bridge); 39 40 return drm_bridge_attach(encoder, encoder_dsi->bridge.next_bridge, 41 &encoder_dsi->bridge, flags); 42 } 43 44 static void meson_encoder_dsi_atomic_enable(struct drm_bridge *bridge, 45 struct drm_atomic_state *state) 46 { 47 struct meson_encoder_dsi *encoder_dsi = bridge_to_meson_encoder_dsi(bridge); 48 struct meson_drm *priv = encoder_dsi->priv; 49 struct drm_connector_state *conn_state; 50 struct drm_crtc_state *crtc_state; 51 struct drm_connector *connector; 52 53 connector = drm_atomic_get_new_connector_for_encoder(state, bridge->encoder); 54 if (WARN_ON(!connector)) 55 return; 56 57 conn_state = drm_atomic_get_new_connector_state(state, connector); 58 if (WARN_ON(!conn_state)) 59 return; 60 61 crtc_state = drm_atomic_get_new_crtc_state(state, conn_state->crtc); 62 if (WARN_ON(!crtc_state)) 63 return; 64 65 /* ENCL clock setup is handled by CCF */ 66 67 meson_venc_mipi_dsi_mode_set(priv, &crtc_state->adjusted_mode); 68 meson_encl_load_gamma(priv); 69 70 writel_relaxed(0, priv->io_base + _REG(ENCL_VIDEO_EN)); 71 72 writel_bits_relaxed(ENCL_VIDEO_MODE_ADV_VFIFO_EN, ENCL_VIDEO_MODE_ADV_VFIFO_EN, 73 priv->io_base + _REG(ENCL_VIDEO_MODE_ADV)); 74 writel_relaxed(0, priv->io_base + _REG(ENCL_TST_EN)); 75 76 writel_bits_relaxed(BIT(0), 0, priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_EN_CTRL)); 77 78 writel_relaxed(1, priv->io_base + _REG(ENCL_VIDEO_EN)); 79 } 80 81 static void meson_encoder_dsi_atomic_disable(struct drm_bridge *bridge, 82 struct drm_atomic_state *state) 83 { 84 struct meson_encoder_dsi *meson_encoder_dsi = 85 bridge_to_meson_encoder_dsi(bridge); 86 struct meson_drm *priv = meson_encoder_dsi->priv; 87 88 writel_relaxed(0, priv->io_base + _REG(ENCL_VIDEO_EN)); 89 90 writel_bits_relaxed(BIT(0), BIT(0), priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_EN_CTRL)); 91 } 92 93 static const struct drm_bridge_funcs meson_encoder_dsi_bridge_funcs = { 94 .attach = meson_encoder_dsi_attach, 95 .atomic_enable = meson_encoder_dsi_atomic_enable, 96 .atomic_disable = meson_encoder_dsi_atomic_disable, 97 .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state, 98 .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state, 99 .atomic_reset = drm_atomic_helper_bridge_reset, 100 }; 101 102 int meson_encoder_dsi_probe(struct meson_drm *priv) 103 { 104 struct meson_encoder_dsi *meson_encoder_dsi; 105 struct device_node *remote; 106 int ret; 107 108 meson_encoder_dsi = devm_drm_bridge_alloc(priv->dev, 109 struct meson_encoder_dsi, 110 bridge, 111 &meson_encoder_dsi_bridge_funcs); 112 if (IS_ERR(meson_encoder_dsi)) 113 return PTR_ERR(meson_encoder_dsi); 114 115 /* DSI Transceiver Bridge */ 116 remote = of_graph_get_remote_node(priv->dev->of_node, 2, 0); 117 if (!remote) { 118 dev_err(priv->dev, "DSI transceiver device is disabled"); 119 return 0; 120 } 121 122 meson_encoder_dsi->bridge.next_bridge = of_drm_find_and_get_bridge(remote); 123 if (!meson_encoder_dsi->bridge.next_bridge) 124 return dev_err_probe(priv->dev, -EPROBE_DEFER, 125 "Failed to find DSI transceiver bridge\n"); 126 127 /* DSI Encoder Bridge */ 128 meson_encoder_dsi->bridge.of_node = priv->dev->of_node; 129 meson_encoder_dsi->bridge.type = DRM_MODE_CONNECTOR_DSI; 130 131 drm_bridge_add(&meson_encoder_dsi->bridge); 132 133 meson_encoder_dsi->priv = priv; 134 135 /* Encoder */ 136 ret = drm_simple_encoder_init(priv->drm, &meson_encoder_dsi->encoder, 137 DRM_MODE_ENCODER_DSI); 138 if (ret) 139 return dev_err_probe(priv->dev, ret, 140 "Failed to init DSI encoder\n"); 141 142 meson_encoder_dsi->encoder.possible_crtcs = BIT(0); 143 144 /* Attach DSI Encoder Bridge to Encoder */ 145 ret = drm_bridge_attach(&meson_encoder_dsi->encoder, &meson_encoder_dsi->bridge, NULL, 0); 146 if (ret) 147 return dev_err_probe(priv->dev, ret, 148 "Failed to attach bridge\n"); 149 150 /* 151 * We should have now in place: 152 * encoder->[dsi encoder bridge]->[dw-mipi-dsi bridge]->[panel bridge]->[panel] 153 */ 154 155 priv->encoders[MESON_ENC_DSI] = meson_encoder_dsi; 156 157 dev_dbg(priv->dev, "DSI encoder initialized\n"); 158 159 return 0; 160 } 161 162 void meson_encoder_dsi_remove(struct meson_drm *priv) 163 { 164 struct meson_encoder_dsi *meson_encoder_dsi; 165 166 if (priv->encoders[MESON_ENC_DSI]) { 167 meson_encoder_dsi = priv->encoders[MESON_ENC_DSI]; 168 drm_bridge_remove(&meson_encoder_dsi->bridge); 169 } 170 } 171