2121#include "rcar_du_drv.h"
2222#include "rcar_du_encoder.h"
2323#include "rcar_du_kms.h"
24- #include "rcar_du_lvdscon.h"
25- #include "rcar_du_lvdsenc.h"
2624
2725/* -----------------------------------------------------------------------------
2826 * Encoder
2927 */
3028
31- static void rcar_du_encoder_disable (struct drm_encoder * encoder )
32- {
33- struct rcar_du_encoder * renc = to_rcar_encoder (encoder );
34-
35- if (renc -> connector && renc -> connector -> panel ) {
36- drm_panel_disable (renc -> connector -> panel );
37- drm_panel_unprepare (renc -> connector -> panel );
38- }
39-
40- if (renc -> lvds )
41- rcar_du_lvdsenc_enable (renc -> lvds , encoder -> crtc , false);
42- }
43-
44- static void rcar_du_encoder_enable (struct drm_encoder * encoder )
45- {
46- struct rcar_du_encoder * renc = to_rcar_encoder (encoder );
47-
48- if (renc -> lvds )
49- rcar_du_lvdsenc_enable (renc -> lvds , encoder -> crtc , true);
50-
51- if (renc -> connector && renc -> connector -> panel ) {
52- drm_panel_prepare (renc -> connector -> panel );
53- drm_panel_enable (renc -> connector -> panel );
54- }
55- }
56-
57- static int rcar_du_encoder_atomic_check (struct drm_encoder * encoder ,
58- struct drm_crtc_state * crtc_state ,
59- struct drm_connector_state * conn_state )
60- {
61- struct rcar_du_encoder * renc = to_rcar_encoder (encoder );
62- struct drm_display_mode * adjusted_mode = & crtc_state -> adjusted_mode ;
63- const struct drm_display_mode * mode = & crtc_state -> mode ;
64- struct drm_connector * connector = conn_state -> connector ;
65- struct drm_device * dev = encoder -> dev ;
66-
67- /*
68- * Only panel-related encoder types require validation here, everything
69- * else is handled by the bridge drivers.
70- */
71- if (connector -> connector_type == DRM_MODE_CONNECTOR_LVDS ) {
72- const struct drm_display_mode * panel_mode ;
73-
74- if (list_empty (& connector -> modes )) {
75- dev_dbg (dev -> dev , "encoder: empty modes list\n" );
76- return - EINVAL ;
77- }
78-
79- panel_mode = list_first_entry (& connector -> modes ,
80- struct drm_display_mode , head );
81-
82- /* We're not allowed to modify the resolution. */
83- if (mode -> hdisplay != panel_mode -> hdisplay ||
84- mode -> vdisplay != panel_mode -> vdisplay )
85- return - EINVAL ;
86-
87- /*
88- * The flat panel mode is fixed, just copy it to the adjusted
89- * mode.
90- */
91- drm_mode_copy (adjusted_mode , panel_mode );
92- }
93-
94- if (renc -> lvds )
95- rcar_du_lvdsenc_atomic_check (renc -> lvds , adjusted_mode );
96-
97- return 0 ;
98- }
99-
10029static void rcar_du_encoder_mode_set (struct drm_encoder * encoder ,
10130 struct drm_crtc_state * crtc_state ,
10231 struct drm_connector_state * conn_state )
10332{
10433 struct rcar_du_encoder * renc = to_rcar_encoder (encoder );
105- struct drm_display_info * info = & conn_state -> connector -> display_info ;
106- enum rcar_lvds_mode mode ;
10734
10835 rcar_du_crtc_route_output (crtc_state -> crtc , renc -> output );
109-
110- if (!renc -> lvds ) {
111- /*
112- * The DU driver creates connectors only for the outputs of the
113- * internal LVDS encoders.
114- */
115- renc -> connector = NULL ;
116- return ;
117- }
118-
119- renc -> connector = to_rcar_connector (conn_state -> connector );
120-
121- if (!info -> num_bus_formats || !info -> bus_formats ) {
122- dev_err (encoder -> dev -> dev , "no LVDS bus format reported\n" );
123- return ;
124- }
125-
126- switch (info -> bus_formats [0 ]) {
127- case MEDIA_BUS_FMT_RGB666_1X7X3_SPWG :
128- case MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA :
129- mode = RCAR_LVDS_MODE_JEIDA ;
130- break ;
131- case MEDIA_BUS_FMT_RGB888_1X7X4_SPWG :
132- mode = RCAR_LVDS_MODE_VESA ;
133- break ;
134- default :
135- dev_err (encoder -> dev -> dev ,
136- "unsupported LVDS bus format 0x%04x\n" ,
137- info -> bus_formats [0 ]);
138- return ;
139- }
140-
141- if (info -> bus_flags & DRM_BUS_FLAG_DATA_LSB_TO_MSB )
142- mode |= RCAR_LVDS_MODE_MIRROR ;
143-
144- rcar_du_lvdsenc_set_mode (renc -> lvds , mode );
14536}
14637
14738static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
14839 .atomic_mode_set = rcar_du_encoder_mode_set ,
149- .disable = rcar_du_encoder_disable ,
150- .enable = rcar_du_encoder_enable ,
151- .atomic_check = rcar_du_encoder_atomic_check ,
15240};
15341
15442static const struct drm_encoder_funcs encoder_funcs = {
@@ -172,33 +60,14 @@ int rcar_du_encoder_init(struct rcar_du_device *rcdu,
17260 renc -> output = output ;
17361 encoder = rcar_encoder_to_drm_encoder (renc );
17462
175- switch (output ) {
176- case RCAR_DU_OUTPUT_LVDS0 :
177- renc -> lvds = rcdu -> lvds [0 ];
178- break ;
63+ dev_dbg (rcdu -> dev , "initializing encoder %pOF for output %u\n" ,
64+ enc_node , output );
17965
180- case RCAR_DU_OUTPUT_LVDS1 :
181- renc -> lvds = rcdu -> lvds [1 ];
182- break ;
183-
184- default :
185- break ;
186- }
187-
188- if (enc_node ) {
189- dev_dbg (rcdu -> dev , "initializing encoder %pOF for output %u\n" ,
190- enc_node , output );
191-
192- /* Locate the DRM bridge from the encoder DT node. */
193- bridge = of_drm_find_bridge (enc_node );
194- if (!bridge ) {
195- ret = - EPROBE_DEFER ;
196- goto done ;
197- }
198- } else {
199- dev_dbg (rcdu -> dev ,
200- "initializing internal encoder for output %u\n" ,
201- output );
66+ /* Locate the DRM bridge from the encoder DT node. */
67+ bridge = of_drm_find_bridge (enc_node );
68+ if (!bridge ) {
69+ ret = - EPROBE_DEFER ;
70+ goto done ;
20271 }
20372
20473 ret = drm_encoder_init (rcdu -> ddev , encoder , & encoder_funcs ,
@@ -208,28 +77,14 @@ int rcar_du_encoder_init(struct rcar_du_device *rcdu,
20877
20978 drm_encoder_helper_add (encoder , & encoder_helper_funcs );
21079
211- if (bridge ) {
212- /*
213- * Attach the bridge to the encoder. The bridge will create the
214- * connector.
215- */
216- ret = drm_bridge_attach (encoder , bridge , NULL );
217- if (ret ) {
218- drm_encoder_cleanup (encoder );
219- return ret ;
220- }
221- } else {
222- /* There's no bridge, create the connector manually. */
223- switch (output ) {
224- case RCAR_DU_OUTPUT_LVDS0 :
225- case RCAR_DU_OUTPUT_LVDS1 :
226- ret = rcar_du_lvds_connector_init (rcdu , renc , con_node );
227- break ;
228-
229- default :
230- ret = - EINVAL ;
231- break ;
232- }
80+ /*
81+ * Attach the bridge to the encoder. The bridge will create the
82+ * connector.
83+ */
84+ ret = drm_bridge_attach (encoder , bridge , NULL );
85+ if (ret ) {
86+ drm_encoder_cleanup (encoder );
87+ return ret ;
23388 }
23489
23590done :
0 commit comments