Commit | Line | Data |
---|---|---|
4bf8e196 | 1 | /* |
6978f123 | 2 | * rcar_du_encoder.c -- R-Car Display Unit Encoder |
4bf8e196 | 3 | * |
36d50464 | 4 | * Copyright (C) 2013-2014 Renesas Electronics Corporation |
4bf8e196 LP |
5 | * |
6 | * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com) | |
7 | * | |
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. | |
12 | */ | |
13 | ||
90374b5c LP |
14 | #include <linux/export.h> |
15 | ||
4bf8e196 LP |
16 | #include <drm/drmP.h> |
17 | #include <drm/drm_crtc.h> | |
18 | #include <drm/drm_crtc_helper.h> | |
19 | ||
20 | #include "rcar_du_drv.h" | |
6978f123 | 21 | #include "rcar_du_encoder.h" |
637e6194 LP |
22 | #include "rcar_du_hdmicon.h" |
23 | #include "rcar_du_hdmienc.h" | |
4bf8e196 | 24 | #include "rcar_du_kms.h" |
56c5dd00 | 25 | #include "rcar_du_lvdscon.h" |
90374b5c | 26 | #include "rcar_du_lvdsenc.h" |
6978f123 | 27 | #include "rcar_du_vgacon.h" |
4bf8e196 | 28 | |
6978f123 LP |
29 | /* ----------------------------------------------------------------------------- |
30 | * Encoder | |
31 | */ | |
32 | ||
f6638b6a | 33 | static void rcar_du_encoder_disable(struct drm_encoder *encoder) |
6978f123 | 34 | { |
90374b5c LP |
35 | struct rcar_du_encoder *renc = to_rcar_encoder(encoder); |
36 | ||
37 | if (renc->lvds) | |
f6638b6a LP |
38 | rcar_du_lvdsenc_enable(renc->lvds, encoder->crtc, false); |
39 | } | |
40 | ||
41 | static void rcar_du_encoder_enable(struct drm_encoder *encoder) | |
42 | { | |
43 | struct rcar_du_encoder *renc = to_rcar_encoder(encoder); | |
44 | ||
45 | if (renc->lvds) | |
46 | rcar_du_lvdsenc_enable(renc->lvds, encoder->crtc, true); | |
47 | } | |
48 | ||
ede7714f LP |
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) | |
4bf8e196 | 52 | { |
90374b5c | 53 | struct rcar_du_encoder *renc = to_rcar_encoder(encoder); |
ede7714f LP |
54 | struct drm_display_mode *adjusted_mode = &crtc_state->adjusted_mode; |
55 | const struct drm_display_mode *mode = &crtc_state->mode; | |
4bf8e196 | 56 | const struct drm_display_mode *panel_mode; |
ede7714f | 57 | struct drm_connector *connector = conn_state->connector; |
4bf8e196 | 58 | struct drm_device *dev = encoder->dev; |
4bf8e196 | 59 | |
6978f123 LP |
60 | /* DAC encoders have currently no restriction on the mode. */ |
61 | if (encoder->encoder_type == DRM_MODE_ENCODER_DAC) | |
ede7714f | 62 | return 0; |
4bf8e196 LP |
63 | |
64 | if (list_empty(&connector->modes)) { | |
ede7714f LP |
65 | dev_dbg(dev->dev, "encoder: empty modes list\n"); |
66 | return -EINVAL; | |
4bf8e196 LP |
67 | } |
68 | ||
69 | panel_mode = list_first_entry(&connector->modes, | |
70 | struct drm_display_mode, head); | |
71 | ||
72 | /* We're not allowed to modify the resolution. */ | |
73 | if (mode->hdisplay != panel_mode->hdisplay || | |
74 | mode->vdisplay != panel_mode->vdisplay) | |
ede7714f | 75 | return -EINVAL; |
4bf8e196 LP |
76 | |
77 | /* The flat panel mode is fixed, just copy it to the adjusted mode. */ | |
78 | drm_mode_copy(adjusted_mode, panel_mode); | |
79 | ||
90374b5c | 80 | if (renc->lvds) |
d9829a32 | 81 | rcar_du_lvdsenc_atomic_check(renc->lvds, adjusted_mode); |
90374b5c | 82 | |
ede7714f | 83 | return 0; |
4bf8e196 LP |
84 | } |
85 | ||
6978f123 LP |
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) | |
89 | { | |
90 | struct rcar_du_encoder *renc = to_rcar_encoder(encoder); | |
91 | ||
92 | rcar_du_crtc_route_output(encoder->crtc, renc->output); | |
93 | } | |
94 | ||
4bf8e196 | 95 | static const struct drm_encoder_helper_funcs encoder_helper_funcs = { |
4bf8e196 | 96 | .mode_set = rcar_du_encoder_mode_set, |
f6638b6a LP |
97 | .disable = rcar_du_encoder_disable, |
98 | .enable = rcar_du_encoder_enable, | |
ede7714f | 99 | .atomic_check = rcar_du_encoder_atomic_check, |
4bf8e196 LP |
100 | }; |
101 | ||
102 | static const struct drm_encoder_funcs encoder_funcs = { | |
103 | .destroy = drm_encoder_cleanup, | |
104 | }; | |
105 | ||
6978f123 | 106 | int rcar_du_encoder_init(struct rcar_du_device *rcdu, |
ef67a902 LP |
107 | enum rcar_du_encoder_type type, |
108 | enum rcar_du_output output, | |
3ea4d5ec LP |
109 | struct device_node *enc_node, |
110 | struct device_node *con_node) | |
4bf8e196 LP |
111 | { |
112 | struct rcar_du_encoder *renc; | |
4b96b70c | 113 | struct drm_encoder *encoder; |
ef67a902 | 114 | unsigned int encoder_type; |
4bf8e196 LP |
115 | int ret; |
116 | ||
117 | renc = devm_kzalloc(rcdu->dev, sizeof(*renc), GFP_KERNEL); | |
118 | if (renc == NULL) | |
119 | return -ENOMEM; | |
120 | ||
121 | renc->output = output; | |
4b96b70c | 122 | encoder = rcar_encoder_to_drm_encoder(renc); |
4bf8e196 | 123 | |
90374b5c LP |
124 | switch (output) { |
125 | case RCAR_DU_OUTPUT_LVDS0: | |
126 | renc->lvds = rcdu->lvds[0]; | |
127 | break; | |
128 | ||
129 | case RCAR_DU_OUTPUT_LVDS1: | |
130 | renc->lvds = rcdu->lvds[1]; | |
131 | break; | |
132 | ||
133 | default: | |
134 | break; | |
135 | } | |
136 | ||
ef67a902 LP |
137 | switch (type) { |
138 | case RCAR_DU_ENCODER_VGA: | |
139 | encoder_type = DRM_MODE_ENCODER_DAC; | |
140 | break; | |
141 | case RCAR_DU_ENCODER_LVDS: | |
142 | encoder_type = DRM_MODE_ENCODER_LVDS; | |
143 | break; | |
637e6194 LP |
144 | case RCAR_DU_ENCODER_HDMI: |
145 | encoder_type = DRM_MODE_ENCODER_TMDS; | |
146 | break; | |
ef67a902 LP |
147 | case RCAR_DU_ENCODER_NONE: |
148 | default: | |
149 | /* No external encoder, use the internal encoder type. */ | |
150 | encoder_type = rcdu->info->routes[output].encoder_type; | |
151 | break; | |
152 | } | |
153 | ||
637e6194 | 154 | if (type == RCAR_DU_ENCODER_HDMI) { |
637e6194 LP |
155 | ret = rcar_du_hdmienc_init(rcdu, renc, enc_node); |
156 | if (ret < 0) | |
347d761c | 157 | goto done; |
637e6194 LP |
158 | } else { |
159 | ret = drm_encoder_init(rcdu->ddev, encoder, &encoder_funcs, | |
13a3d91f | 160 | encoder_type, NULL); |
637e6194 | 161 | if (ret < 0) |
347d761c | 162 | goto done; |
637e6194 LP |
163 | |
164 | drm_encoder_helper_add(encoder, &encoder_helper_funcs); | |
165 | } | |
4bf8e196 | 166 | |
ef67a902 | 167 | switch (encoder_type) { |
2378ad12 | 168 | case DRM_MODE_ENCODER_LVDS: |
347d761c LP |
169 | ret = rcar_du_lvds_connector_init(rcdu, renc, con_node); |
170 | break; | |
6978f123 | 171 | |
ef67a902 | 172 | case DRM_MODE_ENCODER_DAC: |
347d761c LP |
173 | ret = rcar_du_vga_connector_init(rcdu, renc); |
174 | break; | |
6978f123 | 175 | |
637e6194 | 176 | case DRM_MODE_ENCODER_TMDS: |
347d761c LP |
177 | ret = rcar_du_hdmi_connector_init(rcdu, renc); |
178 | break; | |
637e6194 | 179 | |
6978f123 | 180 | default: |
347d761c LP |
181 | ret = -EINVAL; |
182 | break; | |
6978f123 | 183 | } |
347d761c LP |
184 | |
185 | done: | |
186 | if (ret < 0) { | |
187 | if (encoder->name) | |
188 | encoder->funcs->destroy(encoder); | |
189 | devm_kfree(rcdu->dev, renc); | |
190 | } | |
191 | ||
192 | return ret; | |
4bf8e196 | 193 | } |