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 void rcar_du_encoder_dpms(struct drm_encoder
*encoder
, int mode
)
63 if (mode
== DRM_MODE_DPMS_ON
)
64 rcar_du_encoder_enable(encoder
);
66 rcar_du_encoder_disable(encoder
);
69 static bool rcar_du_encoder_mode_fixup(struct drm_encoder
*encoder
,
70 const struct drm_display_mode
*mode
,
71 struct drm_display_mode
*adjusted_mode
)
73 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
74 const struct drm_display_mode
*panel_mode
;
75 struct drm_device
*dev
= encoder
->dev
;
76 struct drm_connector
*connector
;
79 /* DAC encoders have currently no restriction on the mode. */
80 if (encoder
->encoder_type
== DRM_MODE_ENCODER_DAC
)
83 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
84 if (connector
->encoder
== encoder
) {
91 dev_dbg(dev
->dev
, "mode_fixup: no connector found\n");
95 if (list_empty(&connector
->modes
)) {
96 dev_dbg(dev
->dev
, "mode_fixup: empty modes list\n");
100 panel_mode
= list_first_entry(&connector
->modes
,
101 struct drm_display_mode
, head
);
103 /* We're not allowed to modify the resolution. */
104 if (mode
->hdisplay
!= panel_mode
->hdisplay
||
105 mode
->vdisplay
!= panel_mode
->vdisplay
)
108 /* The flat panel mode is fixed, just copy it to the adjusted mode. */
109 drm_mode_copy(adjusted_mode
, panel_mode
);
111 /* The internal LVDS encoder has a clock frequency operating range of
112 * 30MHz to 150MHz. Clamp the clock accordingly.
115 adjusted_mode
->clock
= clamp(adjusted_mode
->clock
,
121 static void rcar_du_encoder_mode_set(struct drm_encoder
*encoder
,
122 struct drm_display_mode
*mode
,
123 struct drm_display_mode
*adjusted_mode
)
125 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
127 rcar_du_crtc_route_output(encoder
->crtc
, renc
->output
);
130 static const struct drm_encoder_helper_funcs encoder_helper_funcs
= {
131 .dpms
= rcar_du_encoder_dpms
,
132 .mode_fixup
= rcar_du_encoder_mode_fixup
,
133 .mode_set
= rcar_du_encoder_mode_set
,
134 .disable
= rcar_du_encoder_disable
,
135 .enable
= rcar_du_encoder_enable
,
138 static const struct drm_encoder_funcs encoder_funcs
= {
139 .destroy
= drm_encoder_cleanup
,
142 int rcar_du_encoder_init(struct rcar_du_device
*rcdu
,
143 enum rcar_du_encoder_type type
,
144 enum rcar_du_output output
,
145 struct device_node
*enc_node
,
146 struct device_node
*con_node
)
148 struct rcar_du_encoder
*renc
;
149 struct drm_encoder
*encoder
;
150 unsigned int encoder_type
;
153 renc
= devm_kzalloc(rcdu
->dev
, sizeof(*renc
), GFP_KERNEL
);
157 renc
->output
= output
;
158 encoder
= rcar_encoder_to_drm_encoder(renc
);
161 case RCAR_DU_OUTPUT_LVDS0
:
162 renc
->lvds
= rcdu
->lvds
[0];
165 case RCAR_DU_OUTPUT_LVDS1
:
166 renc
->lvds
= rcdu
->lvds
[1];
174 case RCAR_DU_ENCODER_VGA
:
175 encoder_type
= DRM_MODE_ENCODER_DAC
;
177 case RCAR_DU_ENCODER_LVDS
:
178 encoder_type
= DRM_MODE_ENCODER_LVDS
;
180 case RCAR_DU_ENCODER_HDMI
:
181 encoder_type
= DRM_MODE_ENCODER_TMDS
;
183 case RCAR_DU_ENCODER_NONE
:
185 /* No external encoder, use the internal encoder type. */
186 encoder_type
= rcdu
->info
->routes
[output
].encoder_type
;
190 if (type
== RCAR_DU_ENCODER_HDMI
) {
191 ret
= rcar_du_hdmienc_init(rcdu
, renc
, enc_node
);
195 ret
= drm_encoder_init(rcdu
->ddev
, encoder
, &encoder_funcs
,
200 drm_encoder_helper_add(encoder
, &encoder_helper_funcs
);
203 switch (encoder_type
) {
204 case DRM_MODE_ENCODER_LVDS
:
205 ret
= rcar_du_lvds_connector_init(rcdu
, renc
, con_node
);
208 case DRM_MODE_ENCODER_DAC
:
209 ret
= rcar_du_vga_connector_init(rcdu
, renc
);
212 case DRM_MODE_ENCODER_TMDS
:
213 ret
= rcar_du_hdmi_connector_init(rcdu
, renc
);
224 encoder
->funcs
->destroy(encoder
);
225 devm_kfree(rcdu
->dev
, renc
);