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 /* -----------------------------------------------------------------------------
33 static void rcar_du_encoder_disable(struct drm_encoder
*encoder
)
35 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
38 rcar_du_lvdsenc_enable(renc
->lvds
, encoder
->crtc
, false);
41 static void rcar_du_encoder_enable(struct drm_encoder
*encoder
)
43 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
46 rcar_du_lvdsenc_enable(renc
->lvds
, encoder
->crtc
, true);
49 static int rcar_du_encoder_atomic_check(struct drm_encoder
*encoder
,
50 struct drm_crtc_state
*crtc_state
,
51 struct drm_connector_state
*conn_state
)
53 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
54 struct drm_display_mode
*adjusted_mode
= &crtc_state
->adjusted_mode
;
55 const struct drm_display_mode
*mode
= &crtc_state
->mode
;
56 const struct drm_display_mode
*panel_mode
;
57 struct drm_connector
*connector
= conn_state
->connector
;
58 struct drm_device
*dev
= encoder
->dev
;
60 /* DAC encoders have currently no restriction on the mode. */
61 if (encoder
->encoder_type
== DRM_MODE_ENCODER_DAC
)
64 if (list_empty(&connector
->modes
)) {
65 dev_dbg(dev
->dev
, "encoder: empty modes list\n");
69 panel_mode
= list_first_entry(&connector
->modes
,
70 struct drm_display_mode
, head
);
72 /* We're not allowed to modify the resolution. */
73 if (mode
->hdisplay
!= panel_mode
->hdisplay
||
74 mode
->vdisplay
!= panel_mode
->vdisplay
)
77 /* The flat panel mode is fixed, just copy it to the adjusted mode. */
78 drm_mode_copy(adjusted_mode
, panel_mode
);
81 rcar_du_lvdsenc_atomic_check(renc
->lvds
, adjusted_mode
);
86 static void rcar_du_encoder_mode_set(struct drm_encoder
*encoder
,
87 struct drm_display_mode
*mode
,
88 struct drm_display_mode
*adjusted_mode
)
90 struct rcar_du_encoder
*renc
= to_rcar_encoder(encoder
);
92 rcar_du_crtc_route_output(encoder
->crtc
, renc
->output
);
95 static const struct drm_encoder_helper_funcs encoder_helper_funcs
= {
96 .mode_set
= rcar_du_encoder_mode_set
,
97 .disable
= rcar_du_encoder_disable
,
98 .enable
= rcar_du_encoder_enable
,
99 .atomic_check
= rcar_du_encoder_atomic_check
,
102 static const struct drm_encoder_funcs encoder_funcs
= {
103 .destroy
= drm_encoder_cleanup
,
106 int rcar_du_encoder_init(struct rcar_du_device
*rcdu
,
107 enum rcar_du_encoder_type type
,
108 enum rcar_du_output output
,
109 struct device_node
*enc_node
,
110 struct device_node
*con_node
)
112 struct rcar_du_encoder
*renc
;
113 struct drm_encoder
*encoder
;
114 unsigned int encoder_type
;
117 renc
= devm_kzalloc(rcdu
->dev
, sizeof(*renc
), GFP_KERNEL
);
121 renc
->output
= output
;
122 encoder
= rcar_encoder_to_drm_encoder(renc
);
125 case RCAR_DU_OUTPUT_LVDS0
:
126 renc
->lvds
= rcdu
->lvds
[0];
129 case RCAR_DU_OUTPUT_LVDS1
:
130 renc
->lvds
= rcdu
->lvds
[1];
138 case RCAR_DU_ENCODER_VGA
:
139 encoder_type
= DRM_MODE_ENCODER_DAC
;
141 case RCAR_DU_ENCODER_LVDS
:
142 encoder_type
= DRM_MODE_ENCODER_LVDS
;
144 case RCAR_DU_ENCODER_HDMI
:
145 encoder_type
= DRM_MODE_ENCODER_TMDS
;
147 case RCAR_DU_ENCODER_NONE
:
149 /* No external encoder, use the internal encoder type. */
150 encoder_type
= rcdu
->info
->routes
[output
].encoder_type
;
154 if (type
== RCAR_DU_ENCODER_HDMI
) {
155 ret
= rcar_du_hdmienc_init(rcdu
, renc
, enc_node
);
159 ret
= drm_encoder_init(rcdu
->ddev
, encoder
, &encoder_funcs
,
164 drm_encoder_helper_add(encoder
, &encoder_helper_funcs
);
167 switch (encoder_type
) {
168 case DRM_MODE_ENCODER_LVDS
:
169 ret
= rcar_du_lvds_connector_init(rcdu
, renc
, con_node
);
172 case DRM_MODE_ENCODER_DAC
:
173 ret
= rcar_du_vga_connector_init(rcdu
, renc
);
176 case DRM_MODE_ENCODER_TMDS
:
177 ret
= rcar_du_hdmi_connector_init(rcdu
, renc
);
188 encoder
->funcs
->destroy(encoder
);
189 devm_kfree(rcdu
->dev
, renc
);