]>
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" |
4bf8e196 | 22 | #include "rcar_du_kms.h" |
56c5dd00 | 23 | #include "rcar_du_lvdscon.h" |
90374b5c | 24 | #include "rcar_du_lvdsenc.h" |
6978f123 | 25 | #include "rcar_du_vgacon.h" |
4bf8e196 | 26 | |
6978f123 LP |
27 | /* ----------------------------------------------------------------------------- |
28 | * Common connector functions | |
29 | */ | |
30 | ||
31 | struct drm_encoder * | |
32 | rcar_du_connector_best_encoder(struct drm_connector *connector) | |
4bf8e196 | 33 | { |
6978f123 LP |
34 | struct rcar_du_connector *rcon = to_rcar_connector(connector); |
35 | ||
4b96b70c | 36 | return rcar_encoder_to_drm_encoder(rcon->encoder); |
4bf8e196 LP |
37 | } |
38 | ||
6978f123 LP |
39 | /* ----------------------------------------------------------------------------- |
40 | * Encoder | |
41 | */ | |
42 | ||
43 | static void rcar_du_encoder_dpms(struct drm_encoder *encoder, int mode) | |
44 | { | |
90374b5c LP |
45 | struct rcar_du_encoder *renc = to_rcar_encoder(encoder); |
46 | ||
47 | if (renc->lvds) | |
48 | rcar_du_lvdsenc_dpms(renc->lvds, encoder->crtc, mode); | |
6978f123 LP |
49 | } |
50 | ||
51 | static bool rcar_du_encoder_mode_fixup(struct drm_encoder *encoder, | |
52 | const struct drm_display_mode *mode, | |
53 | struct drm_display_mode *adjusted_mode) | |
4bf8e196 | 54 | { |
90374b5c | 55 | struct rcar_du_encoder *renc = to_rcar_encoder(encoder); |
4bf8e196 LP |
56 | const struct drm_display_mode *panel_mode; |
57 | struct drm_device *dev = encoder->dev; | |
58 | struct drm_connector *connector; | |
59 | bool found = false; | |
60 | ||
6978f123 LP |
61 | /* DAC encoders have currently no restriction on the mode. */ |
62 | if (encoder->encoder_type == DRM_MODE_ENCODER_DAC) | |
63 | return true; | |
64 | ||
4bf8e196 LP |
65 | list_for_each_entry(connector, &dev->mode_config.connector_list, head) { |
66 | if (connector->encoder == encoder) { | |
67 | found = true; | |
68 | break; | |
69 | } | |
70 | } | |
71 | ||
72 | if (!found) { | |
73 | dev_dbg(dev->dev, "mode_fixup: no connector found\n"); | |
74 | return false; | |
75 | } | |
76 | ||
77 | if (list_empty(&connector->modes)) { | |
78 | dev_dbg(dev->dev, "mode_fixup: empty modes list\n"); | |
79 | return false; | |
80 | } | |
81 | ||
82 | panel_mode = list_first_entry(&connector->modes, | |
83 | struct drm_display_mode, head); | |
84 | ||
85 | /* We're not allowed to modify the resolution. */ | |
86 | if (mode->hdisplay != panel_mode->hdisplay || | |
87 | mode->vdisplay != panel_mode->vdisplay) | |
88 | return false; | |
89 | ||
90 | /* The flat panel mode is fixed, just copy it to the adjusted mode. */ | |
91 | drm_mode_copy(adjusted_mode, panel_mode); | |
92 | ||
90374b5c LP |
93 | /* The internal LVDS encoder has a clock frequency operating range of |
94 | * 30MHz to 150MHz. Clamp the clock accordingly. | |
95 | */ | |
96 | if (renc->lvds) | |
97 | adjusted_mode->clock = clamp(adjusted_mode->clock, | |
98 | 30000, 150000); | |
99 | ||
4bf8e196 LP |
100 | return true; |
101 | } | |
102 | ||
6978f123 LP |
103 | static void rcar_du_encoder_mode_prepare(struct drm_encoder *encoder) |
104 | { | |
90374b5c LP |
105 | struct rcar_du_encoder *renc = to_rcar_encoder(encoder); |
106 | ||
107 | if (renc->lvds) | |
108 | rcar_du_lvdsenc_dpms(renc->lvds, encoder->crtc, | |
109 | DRM_MODE_DPMS_OFF); | |
6978f123 LP |
110 | } |
111 | ||
112 | static void rcar_du_encoder_mode_commit(struct drm_encoder *encoder) | |
113 | { | |
90374b5c LP |
114 | struct rcar_du_encoder *renc = to_rcar_encoder(encoder); |
115 | ||
116 | if (renc->lvds) | |
117 | rcar_du_lvdsenc_dpms(renc->lvds, encoder->crtc, | |
118 | DRM_MODE_DPMS_ON); | |
6978f123 LP |
119 | } |
120 | ||
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) | |
124 | { | |
125 | struct rcar_du_encoder *renc = to_rcar_encoder(encoder); | |
126 | ||
127 | rcar_du_crtc_route_output(encoder->crtc, renc->output); | |
128 | } | |
129 | ||
4bf8e196 | 130 | static const struct drm_encoder_helper_funcs encoder_helper_funcs = { |
6978f123 LP |
131 | .dpms = rcar_du_encoder_dpms, |
132 | .mode_fixup = rcar_du_encoder_mode_fixup, | |
4bf8e196 LP |
133 | .prepare = rcar_du_encoder_mode_prepare, |
134 | .commit = rcar_du_encoder_mode_commit, | |
135 | .mode_set = rcar_du_encoder_mode_set, | |
136 | }; | |
137 | ||
138 | static const struct drm_encoder_funcs encoder_funcs = { | |
139 | .destroy = drm_encoder_cleanup, | |
140 | }; | |
141 | ||
6978f123 | 142 | int rcar_du_encoder_init(struct rcar_du_device *rcdu, |
ef67a902 LP |
143 | enum rcar_du_encoder_type type, |
144 | enum rcar_du_output output, | |
3ea4d5ec LP |
145 | struct device_node *enc_node, |
146 | struct device_node *con_node) | |
4bf8e196 LP |
147 | { |
148 | struct rcar_du_encoder *renc; | |
4b96b70c | 149 | struct drm_encoder *encoder; |
ef67a902 | 150 | unsigned int encoder_type; |
4bf8e196 LP |
151 | int ret; |
152 | ||
153 | renc = devm_kzalloc(rcdu->dev, sizeof(*renc), GFP_KERNEL); | |
154 | if (renc == NULL) | |
155 | return -ENOMEM; | |
156 | ||
157 | renc->output = output; | |
4b96b70c | 158 | encoder = rcar_encoder_to_drm_encoder(renc); |
4bf8e196 | 159 | |
90374b5c LP |
160 | switch (output) { |
161 | case RCAR_DU_OUTPUT_LVDS0: | |
162 | renc->lvds = rcdu->lvds[0]; | |
163 | break; | |
164 | ||
165 | case RCAR_DU_OUTPUT_LVDS1: | |
166 | renc->lvds = rcdu->lvds[1]; | |
167 | break; | |
168 | ||
169 | default: | |
170 | break; | |
171 | } | |
172 | ||
ef67a902 LP |
173 | switch (type) { |
174 | case RCAR_DU_ENCODER_VGA: | |
175 | encoder_type = DRM_MODE_ENCODER_DAC; | |
176 | break; | |
177 | case RCAR_DU_ENCODER_LVDS: | |
178 | encoder_type = DRM_MODE_ENCODER_LVDS; | |
179 | break; | |
180 | case RCAR_DU_ENCODER_NONE: | |
181 | default: | |
182 | /* No external encoder, use the internal encoder type. */ | |
183 | encoder_type = rcdu->info->routes[output].encoder_type; | |
184 | break; | |
185 | } | |
186 | ||
4b96b70c | 187 | ret = drm_encoder_init(rcdu->ddev, encoder, &encoder_funcs, |
ef67a902 | 188 | encoder_type); |
4bf8e196 LP |
189 | if (ret < 0) |
190 | return ret; | |
191 | ||
4b96b70c | 192 | drm_encoder_helper_add(encoder, &encoder_helper_funcs); |
4bf8e196 | 193 | |
ef67a902 | 194 | switch (encoder_type) { |
2378ad12 | 195 | case DRM_MODE_ENCODER_LVDS: |
3ea4d5ec | 196 | return rcar_du_lvds_connector_init(rcdu, renc, con_node); |
6978f123 | 197 | |
ef67a902 | 198 | case DRM_MODE_ENCODER_DAC: |
6978f123 LP |
199 | return rcar_du_vga_connector_init(rcdu, renc); |
200 | ||
201 | default: | |
202 | return -EINVAL; | |
203 | } | |
4bf8e196 | 204 | } |