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_dpms(struct drm_encoder *encoder, int mode)
47 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
50 rcar_du_lvdsenc_dpms(renc->lvds, encoder->crtc, mode);
53 static bool rcar_du_encoder_mode_fixup(struct drm_encoder *encoder,
54 const struct drm_display_mode *mode,
55 struct drm_display_mode *adjusted_mode)
57 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
58 const struct drm_display_mode *panel_mode;
59 struct drm_device *dev = encoder->dev;
60 struct drm_connector *connector;
63 /* DAC encoders have currently no restriction on the mode. */
64 if (encoder->encoder_type == DRM_MODE_ENCODER_DAC)
67 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
68 if (connector->encoder == encoder) {
75 dev_dbg(dev->dev, "mode_fixup: no connector found\n");
79 if (list_empty(&connector->modes)) {
80 dev_dbg(dev->dev, "mode_fixup: empty modes list\n");
84 panel_mode = list_first_entry(&connector->modes,
85 struct drm_display_mode, head);
87 /* We're not allowed to modify the resolution. */
88 if (mode->hdisplay != panel_mode->hdisplay ||
89 mode->vdisplay != panel_mode->vdisplay)
92 /* The flat panel mode is fixed, just copy it to the adjusted mode. */
93 drm_mode_copy(adjusted_mode, panel_mode);
95 /* The internal LVDS encoder has a clock frequency operating range of
96 * 30MHz to 150MHz. Clamp the clock accordingly.
99 adjusted_mode->clock = clamp(adjusted_mode->clock,
105 static void rcar_du_encoder_mode_prepare(struct drm_encoder *encoder)
107 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
110 rcar_du_lvdsenc_dpms(renc->lvds, encoder->crtc,
114 static void rcar_du_encoder_mode_commit(struct drm_encoder *encoder)
116 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
119 rcar_du_lvdsenc_dpms(renc->lvds, encoder->crtc,
123 static void rcar_du_encoder_mode_set(struct drm_encoder *encoder,
124 struct drm_display_mode *mode,
125 struct drm_display_mode *adjusted_mode)
127 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
129 rcar_du_crtc_route_output(encoder->crtc, renc->output);
132 static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
133 .dpms = rcar_du_encoder_dpms,
134 .mode_fixup = rcar_du_encoder_mode_fixup,
135 .prepare = rcar_du_encoder_mode_prepare,
136 .commit = rcar_du_encoder_mode_commit,
137 .mode_set = rcar_du_encoder_mode_set,
140 static const struct drm_encoder_funcs encoder_funcs = {
141 .destroy = drm_encoder_cleanup,
144 int rcar_du_encoder_init(struct rcar_du_device *rcdu,
145 enum rcar_du_encoder_type type,
146 enum rcar_du_output output,
147 struct device_node *enc_node,
148 struct device_node *con_node)
150 struct rcar_du_encoder *renc;
151 struct drm_encoder *encoder;
152 unsigned int encoder_type;
155 renc = devm_kzalloc(rcdu->dev, sizeof(*renc), GFP_KERNEL);
159 renc->output = output;
160 encoder = rcar_encoder_to_drm_encoder(renc);
163 case RCAR_DU_OUTPUT_LVDS0:
164 renc->lvds = rcdu->lvds[0];
167 case RCAR_DU_OUTPUT_LVDS1:
168 renc->lvds = rcdu->lvds[1];
176 case RCAR_DU_ENCODER_VGA:
177 encoder_type = DRM_MODE_ENCODER_DAC;
179 case RCAR_DU_ENCODER_LVDS:
180 encoder_type = DRM_MODE_ENCODER_LVDS;
182 case RCAR_DU_ENCODER_HDMI:
183 encoder_type = DRM_MODE_ENCODER_TMDS;
185 case RCAR_DU_ENCODER_NONE:
187 /* No external encoder, use the internal encoder type. */
188 encoder_type = rcdu->info->routes[output].encoder_type;
192 if (type == RCAR_DU_ENCODER_HDMI) {
195 "Chaining LVDS and HDMI encoders not supported\n");
199 ret = rcar_du_hdmienc_init(rcdu, renc, enc_node);
203 ret = drm_encoder_init(rcdu->ddev, encoder, &encoder_funcs,
208 drm_encoder_helper_add(encoder, &encoder_helper_funcs);
211 switch (encoder_type) {
212 case DRM_MODE_ENCODER_LVDS:
213 return rcar_du_lvds_connector_init(rcdu, renc, con_node);
215 case DRM_MODE_ENCODER_DAC:
216 return rcar_du_vga_connector_init(rcdu, renc);
218 case DRM_MODE_ENCODER_TMDS:
219 return rcar_du_hdmi_connector_init(rcdu, renc);