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 
meson_encoder_dsi_attach(struct drm_bridge * bridge,enum drm_bridge_attach_flags flags)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 
meson_encoder_dsi_atomic_enable(struct drm_bridge * bridge,struct drm_atomic_state * state)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 
meson_encoder_dsi_atomic_disable(struct drm_bridge * bridge,struct drm_atomic_state * state)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 
meson_encoder_dsi_probe(struct meson_drm * priv)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 
meson_encoder_dsi_remove(struct meson_drm * priv)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