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 drm_bridge *next_bridge; 29 struct meson_drm *priv; 30 }; 31 32 #define bridge_to_meson_encoder_dsi(x) \ 33 container_of(x, struct meson_encoder_dsi, bridge) 34 35 static int meson_encoder_dsi_attach(struct drm_bridge *bridge, 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(bridge->encoder, encoder_dsi->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_kzalloc(priv->dev, sizeof(*meson_encoder_dsi), GFP_KERNEL); 109 if (!meson_encoder_dsi) 110 return -ENOMEM; 111 112 /* DSI Transceiver Bridge */ 113 remote = of_graph_get_remote_node(priv->dev->of_node, 2, 0); 114 if (!remote) { 115 dev_err(priv->dev, "DSI transceiver device is disabled"); 116 return 0; 117 } 118 119 meson_encoder_dsi->next_bridge = of_drm_find_bridge(remote); 120 if (!meson_encoder_dsi->next_bridge) 121 return dev_err_probe(priv->dev, -EPROBE_DEFER, 122 "Failed to find DSI transceiver bridge\n"); 123 124 /* DSI Encoder Bridge */ 125 meson_encoder_dsi->bridge.funcs = &meson_encoder_dsi_bridge_funcs; 126 meson_encoder_dsi->bridge.of_node = priv->dev->of_node; 127 meson_encoder_dsi->bridge.type = DRM_MODE_CONNECTOR_DSI; 128 129 drm_bridge_add(&meson_encoder_dsi->bridge); 130 131 meson_encoder_dsi->priv = priv; 132 133 /* Encoder */ 134 ret = drm_simple_encoder_init(priv->drm, &meson_encoder_dsi->encoder, 135 DRM_MODE_ENCODER_DSI); 136 if (ret) 137 return dev_err_probe(priv->dev, ret, 138 "Failed to init DSI encoder\n"); 139 140 meson_encoder_dsi->encoder.possible_crtcs = BIT(0); 141 142 /* Attach DSI Encoder Bridge to Encoder */ 143 ret = drm_bridge_attach(&meson_encoder_dsi->encoder, &meson_encoder_dsi->bridge, NULL, 0); 144 if (ret) 145 return dev_err_probe(priv->dev, ret, 146 "Failed to attach bridge\n"); 147 148 /* 149 * We should have now in place: 150 * encoder->[dsi encoder bridge]->[dw-mipi-dsi bridge]->[panel bridge]->[panel] 151 */ 152 153 priv->encoders[MESON_ENC_DSI] = meson_encoder_dsi; 154 155 dev_dbg(priv->dev, "DSI encoder initialized\n"); 156 157 return 0; 158 } 159 160 void meson_encoder_dsi_remove(struct meson_drm *priv) 161 { 162 struct meson_encoder_dsi *meson_encoder_dsi; 163 164 if (priv->encoders[MESON_ENC_DSI]) { 165 meson_encoder_dsi = priv->encoders[MESON_ENC_DSI]; 166 drm_bridge_remove(&meson_encoder_dsi->bridge); 167 } 168 } 169