1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <drm/drm_edid.h>
21
22#include "omap_drv.h"
23
24#include "drm_crtc.h"
25#include "drm_crtc_helper.h"
26
27#include <linux/list.h>
28
29
30
31
32
33
34#define to_omap_encoder(x) container_of(x, struct omap_encoder, base)
35
36
37
38
39
40
41struct omap_encoder {
42 struct drm_encoder base;
43 struct omap_dss_device *dssdev;
44};
45
46struct omap_dss_device *omap_encoder_get_dssdev(struct drm_encoder *encoder)
47{
48 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
49
50 return omap_encoder->dssdev;
51}
52
53static void omap_encoder_destroy(struct drm_encoder *encoder)
54{
55 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
56
57 omap_encoder_set_enabled(encoder, false);
58
59 drm_encoder_cleanup(encoder);
60 kfree(omap_encoder);
61}
62
63static const struct drm_encoder_funcs omap_encoder_funcs = {
64 .destroy = omap_encoder_destroy,
65};
66
67
68
69
70
71
72
73
74
75
76
77
78
79static void omap_encoder_dpms(struct drm_encoder *encoder, int mode)
80{
81}
82
83static bool omap_encoder_mode_fixup(struct drm_encoder *encoder,
84 const struct drm_display_mode *mode,
85 struct drm_display_mode *adjusted_mode)
86{
87 return true;
88}
89
90static void omap_encoder_mode_set(struct drm_encoder *encoder,
91 struct drm_display_mode *mode,
92 struct drm_display_mode *adjusted_mode)
93{
94 struct drm_device *dev = encoder->dev;
95 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
96 struct omap_dss_device *dssdev = omap_encoder->dssdev;
97 struct drm_connector *connector;
98 bool hdmi_mode;
99 int r;
100
101 hdmi_mode = false;
102 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
103 if (connector->encoder == encoder) {
104 hdmi_mode = omap_connector_get_hdmi_mode(connector);
105 break;
106 }
107 }
108
109 if (dssdev->driver->set_hdmi_mode)
110 dssdev->driver->set_hdmi_mode(dssdev, hdmi_mode);
111
112 if (hdmi_mode && dssdev->driver->set_hdmi_infoframe) {
113 struct hdmi_avi_infoframe avi;
114
115 r = drm_hdmi_avi_infoframe_from_display_mode(&avi, adjusted_mode);
116 if (r == 0)
117 dssdev->driver->set_hdmi_infoframe(dssdev, &avi);
118 }
119}
120
121static void omap_encoder_prepare(struct drm_encoder *encoder)
122{
123}
124
125static void omap_encoder_commit(struct drm_encoder *encoder)
126{
127}
128
129static const struct drm_encoder_helper_funcs omap_encoder_helper_funcs = {
130 .dpms = omap_encoder_dpms,
131 .mode_fixup = omap_encoder_mode_fixup,
132 .mode_set = omap_encoder_mode_set,
133 .prepare = omap_encoder_prepare,
134 .commit = omap_encoder_commit,
135};
136
137
138
139
140
141
142int omap_encoder_set_enabled(struct drm_encoder *encoder, bool enabled)
143{
144 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
145 struct omap_dss_device *dssdev = omap_encoder->dssdev;
146 struct omap_dss_driver *dssdrv = dssdev->driver;
147
148 if (enabled) {
149 return dssdrv->enable(dssdev);
150 } else {
151 dssdrv->disable(dssdev);
152 return 0;
153 }
154}
155
156int omap_encoder_update(struct drm_encoder *encoder,
157 struct omap_overlay_manager *mgr,
158 struct omap_video_timings *timings)
159{
160 struct drm_device *dev = encoder->dev;
161 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
162 struct omap_dss_device *dssdev = omap_encoder->dssdev;
163 struct omap_dss_driver *dssdrv = dssdev->driver;
164 int ret;
165
166 dssdev->src->manager = mgr;
167
168 if (dssdrv->check_timings) {
169 ret = dssdrv->check_timings(dssdev, timings);
170 } else {
171 struct omap_video_timings t = {0};
172
173 dssdrv->get_timings(dssdev, &t);
174
175 if (memcmp(timings, &t, sizeof(struct omap_video_timings)))
176 ret = -EINVAL;
177 else
178 ret = 0;
179 }
180
181 if (ret) {
182 dev_err(dev->dev, "could not set timings: %d\n", ret);
183 return ret;
184 }
185
186 if (dssdrv->set_timings)
187 dssdrv->set_timings(dssdev, timings);
188
189 return 0;
190}
191
192
193struct drm_encoder *omap_encoder_init(struct drm_device *dev,
194 struct omap_dss_device *dssdev)
195{
196 struct drm_encoder *encoder = NULL;
197 struct omap_encoder *omap_encoder;
198
199 omap_encoder = kzalloc(sizeof(*omap_encoder), GFP_KERNEL);
200 if (!omap_encoder)
201 goto fail;
202
203 omap_encoder->dssdev = dssdev;
204
205 encoder = &omap_encoder->base;
206
207 drm_encoder_init(dev, encoder, &omap_encoder_funcs,
208 DRM_MODE_ENCODER_TMDS);
209 drm_encoder_helper_add(encoder, &omap_encoder_helper_funcs);
210
211 return encoder;
212
213fail:
214 if (encoder)
215 omap_encoder_destroy(encoder);
216
217 return NULL;
218}
219