2 * rcar_du_encoder.c -- R-Car Display Unit Encoder
4 * Copyright (C) 2013-2014 Renesas Electronics Corporation
6 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
14 #include <linux/export.h>
17 #include <drm/drm_crtc.h>
18 #include <drm/drm_crtc_helper.h>
20 #include "rcar_du_drv.h"
21 #include "rcar_du_encoder.h"
22 #include "rcar_du_hdmicon.h"
23 #include "rcar_du_hdmienc.h"
24 #include "rcar_du_kms.h"
25 #include "rcar_du_lvdscon.h"
26 #include "rcar_du_lvdsenc.h"
27 #include "rcar_du_vgacon.h"
29 /* -----------------------------------------------------------------------------
30 * Common connector functions
34 rcar_du_connector_best_encoder(struct drm_connector
*connector
)
36 struct rcar_du_connector
*rcon
= to_rcar_connector(connector
);
38 return rcar_encoder_to_drm_encoder(rcon
->encoder
);
41 /* -----------------------------------------------------------------------------
45 static void rcar_du_encoder_disable(struct drm_encoder
*encoder
)
47 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
50 rcar_du_lvdsenc_enable(renc
->lvds
, encoder
->crtc
, false);
53 static void rcar_du_encoder_enable(struct drm_encoder
*encoder
)
55 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
58 rcar_du_lvdsenc_enable(renc
->lvds
, encoder
->crtc
, true);
61 static int rcar_du_encoder_atomic_check(struct drm_encoder
*encoder
,
62 struct drm_crtc_state
*crtc_state
,
63 struct drm_connector_state
*conn_state
)
65 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
66 struct drm_display_mode
*adjusted_mode
= &crtc_state
->adjusted_mode
;
67 const struct drm_display_mode
*mode
= &crtc_state
->mode
;
68 const struct drm_display_mode
*panel_mode
;
69 struct drm_connector
*connector
= conn_state
->connector
;
70 struct drm_device
*dev
= encoder
->dev
;
72 /* DAC encoders have currently no restriction on the mode. */
73 if (encoder
->encoder_type
== DRM_MODE_ENCODER_DAC
)
76 if (list_empty(&connector
->modes
)) {
77 dev_dbg(dev
->dev
, "encoder: empty modes list\n");
81 panel_mode
= list_first_entry(&connector
->modes
,
82 struct drm_display_mode
, head
);
84 /* We're not allowed to modify the resolution. */
85 if (mode
->hdisplay
!= panel_mode
->hdisplay
||
86 mode
->vdisplay
!= panel_mode
->vdisplay
)
89 /* The flat panel mode is fixed, just copy it to the adjusted mode. */
90 drm_mode_copy(adjusted_mode
, panel_mode
);
93 rcar_du_lvdsenc_atomic_check(renc
->lvds
, adjusted_mode
);
98 static void rcar_du_encoder_mode_set(struct drm_encoder
*encoder
,
99 struct drm_display_mode
*mode
,
100 struct drm_display_mode
*adjusted_mode
)
102 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
104 rcar_du_crtc_route_output(encoder
->crtc
, renc
->output
);
107 static const struct drm_encoder_helper_funcs encoder_helper_funcs
= {
108 .mode_set
= rcar_du_encoder_mode_set
,
109 .disable
= rcar_du_encoder_disable
,
110 .enable
= rcar_du_encoder_enable
,
111 .atomic_check
= rcar_du_encoder_atomic_check
,
114 static const struct drm_encoder_funcs encoder_funcs
= {
115 .destroy
= drm_encoder_cleanup
,
118 int rcar_du_encoder_init(struct rcar_du_device
*rcdu
,
119 enum rcar_du_encoder_type type
,
120 enum rcar_du_output output
,
121 struct device_node
*enc_node
,
122 struct device_node
*con_node
)
124 struct rcar_du_encoder
*renc
;
125 struct drm_encoder
*encoder
;
126 unsigned int encoder_type
;
129 renc
= devm_kzalloc(rcdu
->dev
, sizeof(*renc
), GFP_KERNEL
);
133 renc
->output
= output
;
134 encoder
= rcar_encoder_to_drm_encoder(renc
);
137 case RCAR_DU_OUTPUT_LVDS0
:
138 renc
->lvds
= rcdu
->lvds
[0];
141 case RCAR_DU_OUTPUT_LVDS1
:
142 renc
->lvds
= rcdu
->lvds
[1];
150 case RCAR_DU_ENCODER_VGA
:
151 encoder_type
= DRM_MODE_ENCODER_DAC
;
153 case RCAR_DU_ENCODER_LVDS
:
154 encoder_type
= DRM_MODE_ENCODER_LVDS
;
156 case RCAR_DU_ENCODER_HDMI
:
157 encoder_type
= DRM_MODE_ENCODER_TMDS
;
159 case RCAR_DU_ENCODER_NONE
:
161 /* No external encoder, use the internal encoder type. */
162 encoder_type
= rcdu
->info
->routes
[output
].encoder_type
;
166 if (type
== RCAR_DU_ENCODER_HDMI
) {
167 ret
= rcar_du_hdmienc_init(rcdu
, renc
, enc_node
);
171 ret
= drm_encoder_init(rcdu
->ddev
, encoder
, &encoder_funcs
,
176 drm_encoder_helper_add(encoder
, &encoder_helper_funcs
);
179 switch (encoder_type
) {
180 case DRM_MODE_ENCODER_LVDS
:
181 ret
= rcar_du_lvds_connector_init(rcdu
, renc
, con_node
);
184 case DRM_MODE_ENCODER_DAC
:
185 ret
= rcar_du_vga_connector_init(rcdu
, renc
);
188 case DRM_MODE_ENCODER_TMDS
:
189 ret
= rcar_du_hdmi_connector_init(rcdu
, renc
);
200 encoder
->funcs
->destroy(encoder
);
201 devm_kfree(rcdu
->dev
, renc
);