2 * Copyright (C) 2015 Free Electrons
3 * Copyright (C) 2015 NextThing Co
5 * Maxime Ripard <maxime.ripard@free-electrons.com>
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation; either version 2 of
10 * the License, or (at your option) any later version.
13 #include <linux/clk.h>
16 #include <drm/drm_atomic_helper.h>
17 #include <drm/drm_crtc_helper.h>
18 #include <drm/drm_panel.h>
20 #include "sun4i_drv.h"
21 #include "sun4i_tcon.h"
24 struct drm_connector connector
;
25 struct drm_encoder encoder
;
27 struct sun4i_drv
*drv
;
30 static inline struct sun4i_rgb
*
31 drm_connector_to_sun4i_rgb(struct drm_connector
*connector
)
33 return container_of(connector
, struct sun4i_rgb
,
37 static inline struct sun4i_rgb
*
38 drm_encoder_to_sun4i_rgb(struct drm_encoder
*encoder
)
40 return container_of(encoder
, struct sun4i_rgb
,
44 static int sun4i_rgb_get_modes(struct drm_connector
*connector
)
46 struct sun4i_rgb
*rgb
=
47 drm_connector_to_sun4i_rgb(connector
);
48 struct sun4i_drv
*drv
= rgb
->drv
;
49 struct sun4i_tcon
*tcon
= drv
->tcon
;
51 return drm_panel_get_modes(tcon
->panel
);
54 static int sun4i_rgb_mode_valid(struct drm_connector
*connector
,
55 struct drm_display_mode
*mode
)
57 u32 hsync
= mode
->hsync_end
- mode
->hsync_start
;
58 u32 vsync
= mode
->vsync_end
- mode
->vsync_start
;
60 DRM_DEBUG_DRIVER("Validating modes...\n");
63 return MODE_HSYNC_NARROW
;
66 return MODE_HSYNC_WIDE
;
68 if ((mode
->hdisplay
< 1) || (mode
->htotal
< 1))
69 return MODE_H_ILLEGAL
;
71 if ((mode
->hdisplay
> 0x7ff) || (mode
->htotal
> 0xfff))
72 return MODE_BAD_HVALUE
;
74 DRM_DEBUG_DRIVER("Horizontal parameters OK\n");
77 return MODE_VSYNC_NARROW
;
80 return MODE_VSYNC_WIDE
;
82 if ((mode
->vdisplay
< 1) || (mode
->vtotal
< 1))
83 return MODE_V_ILLEGAL
;
85 if ((mode
->vdisplay
> 0x7ff) || (mode
->vtotal
> 0xfff))
86 return MODE_BAD_VVALUE
;
88 DRM_DEBUG_DRIVER("Vertical parameters OK\n");
93 static struct drm_encoder
*
94 sun4i_rgb_best_encoder(struct drm_connector
*connector
)
96 struct sun4i_rgb
*rgb
=
97 drm_connector_to_sun4i_rgb(connector
);
102 static struct drm_connector_helper_funcs sun4i_rgb_con_helper_funcs
= {
103 .get_modes
= sun4i_rgb_get_modes
,
104 .mode_valid
= sun4i_rgb_mode_valid
,
105 .best_encoder
= sun4i_rgb_best_encoder
,
108 static enum drm_connector_status
109 sun4i_rgb_connector_detect(struct drm_connector
*connector
, bool force
)
111 return connector_status_connected
;
115 sun4i_rgb_connector_destroy(struct drm_connector
*connector
)
117 struct sun4i_rgb
*rgb
= drm_connector_to_sun4i_rgb(connector
);
118 struct sun4i_drv
*drv
= rgb
->drv
;
119 struct sun4i_tcon
*tcon
= drv
->tcon
;
121 drm_panel_detach(tcon
->panel
);
122 drm_connector_cleanup(connector
);
125 static struct drm_connector_funcs sun4i_rgb_con_funcs
= {
126 .dpms
= drm_atomic_helper_connector_dpms
,
127 .detect
= sun4i_rgb_connector_detect
,
128 .fill_modes
= drm_helper_probe_single_connector_modes
,
129 .destroy
= sun4i_rgb_connector_destroy
,
130 .reset
= drm_atomic_helper_connector_reset
,
131 .atomic_duplicate_state
= drm_atomic_helper_connector_duplicate_state
,
132 .atomic_destroy_state
= drm_atomic_helper_connector_destroy_state
,
135 static int sun4i_rgb_atomic_check(struct drm_encoder
*encoder
,
136 struct drm_crtc_state
*crtc_state
,
137 struct drm_connector_state
*conn_state
)
142 static void sun4i_rgb_encoder_enable(struct drm_encoder
*encoder
)
144 struct sun4i_rgb
*rgb
= drm_encoder_to_sun4i_rgb(encoder
);
145 struct sun4i_drv
*drv
= rgb
->drv
;
146 struct sun4i_tcon
*tcon
= drv
->tcon
;
148 DRM_DEBUG_DRIVER("Enabling RGB output\n");
150 drm_panel_enable(tcon
->panel
);
151 sun4i_tcon_channel_enable(tcon
, 0);
154 static void sun4i_rgb_encoder_disable(struct drm_encoder
*encoder
)
156 struct sun4i_rgb
*rgb
= drm_encoder_to_sun4i_rgb(encoder
);
157 struct sun4i_drv
*drv
= rgb
->drv
;
158 struct sun4i_tcon
*tcon
= drv
->tcon
;
160 DRM_DEBUG_DRIVER("Disabling RGB output\n");
162 sun4i_tcon_channel_disable(tcon
, 0);
163 drm_panel_disable(tcon
->panel
);
166 static void sun4i_rgb_encoder_mode_set(struct drm_encoder
*encoder
,
167 struct drm_display_mode
*mode
,
168 struct drm_display_mode
*adjusted_mode
)
170 struct sun4i_rgb
*rgb
= drm_encoder_to_sun4i_rgb(encoder
);
171 struct sun4i_drv
*drv
= rgb
->drv
;
172 struct sun4i_tcon
*tcon
= drv
->tcon
;
174 sun4i_tcon0_mode_set(tcon
, mode
);
176 clk_set_rate(tcon
->dclk
, mode
->crtc_clock
* 1000);
178 /* FIXME: This seems to be board specific */
179 clk_set_phase(tcon
->dclk
, 120);
182 static struct drm_encoder_helper_funcs sun4i_rgb_enc_helper_funcs
= {
183 .atomic_check
= sun4i_rgb_atomic_check
,
184 .mode_set
= sun4i_rgb_encoder_mode_set
,
185 .disable
= sun4i_rgb_encoder_disable
,
186 .enable
= sun4i_rgb_encoder_enable
,
189 static void sun4i_rgb_enc_destroy(struct drm_encoder
*encoder
)
191 drm_encoder_cleanup(encoder
);
194 static struct drm_encoder_funcs sun4i_rgb_enc_funcs
= {
195 .destroy
= sun4i_rgb_enc_destroy
,
198 int sun4i_rgb_init(struct drm_device
*drm
)
200 struct sun4i_drv
*drv
= drm
->dev_private
;
201 struct sun4i_tcon
*tcon
= drv
->tcon
;
202 struct sun4i_rgb
*rgb
;
205 /* If we don't have a panel, there's no point in going on */
209 rgb
= devm_kzalloc(drm
->dev
, sizeof(*rgb
), GFP_KERNEL
);
214 drm_encoder_helper_add(&rgb
->encoder
,
215 &sun4i_rgb_enc_helper_funcs
);
216 ret
= drm_encoder_init(drm
,
218 &sun4i_rgb_enc_funcs
,
219 DRM_MODE_ENCODER_NONE
,
222 dev_err(drm
->dev
, "Couldn't initialise the rgb encoder\n");
226 /* The RGB encoder can only work with the TCON channel 0 */
227 rgb
->encoder
.possible_crtcs
= BIT(0);
229 drm_connector_helper_add(&rgb
->connector
,
230 &sun4i_rgb_con_helper_funcs
);
231 ret
= drm_connector_init(drm
, &rgb
->connector
,
232 &sun4i_rgb_con_funcs
,
233 DRM_MODE_CONNECTOR_Unknown
);
235 dev_err(drm
->dev
, "Couldn't initialise the rgb connector\n");
236 goto err_cleanup_connector
;
239 drm_mode_connector_attach_encoder(&rgb
->connector
, &rgb
->encoder
);
241 drm_panel_attach(tcon
->panel
, &rgb
->connector
);
245 err_cleanup_connector
:
246 drm_encoder_cleanup(&rgb
->encoder
);
250 EXPORT_SYMBOL(sun4i_rgb_init
);