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