Loading...
1/*
2 * drivers/gpu/drm/omapdrm/omap_encoder.c
3 *
4 * Copyright (C) 2011 Texas Instruments
5 * Author: Rob Clark <rob@ti.com>
6 *
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License version 2 as published by
9 * the Free Software Foundation.
10 *
11 * This program is distributed in the hope that it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
14 * more details.
15 *
16 * You should have received a copy of the GNU General Public License along with
17 * this program. If not, see <http://www.gnu.org/licenses/>.
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 * encoder funcs
30 */
31
32#define to_omap_encoder(x) container_of(x, struct omap_encoder, base)
33
34/* The encoder and connector both map to same dssdev.. the encoder
35 * handles the 'active' parts, ie. anything the modifies the state
36 * of the hw, and the connector handles the 'read-only' parts, like
37 * detecting connection and reading edid.
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 int r;
143
144 omap_encoder_update(encoder, omap_crtc_channel(encoder->crtc),
145 omap_crtc_timings(encoder->crtc));
146
147 r = dssdrv->enable(dssdev);
148 if (r)
149 dev_err(encoder->dev->dev,
150 "Failed to enable display '%s': %d\n",
151 dssdev->name, r);
152}
153
154static int omap_encoder_atomic_check(struct drm_encoder *encoder,
155 struct drm_crtc_state *crtc_state,
156 struct drm_connector_state *conn_state)
157{
158 return 0;
159}
160
161static const struct drm_encoder_helper_funcs omap_encoder_helper_funcs = {
162 .mode_set = omap_encoder_mode_set,
163 .disable = omap_encoder_disable,
164 .enable = omap_encoder_enable,
165 .atomic_check = omap_encoder_atomic_check,
166};
167
168/* initialize encoder */
169struct drm_encoder *omap_encoder_init(struct drm_device *dev,
170 struct omap_dss_device *dssdev)
171{
172 struct drm_encoder *encoder = NULL;
173 struct omap_encoder *omap_encoder;
174
175 omap_encoder = kzalloc(sizeof(*omap_encoder), GFP_KERNEL);
176 if (!omap_encoder)
177 goto fail;
178
179 omap_encoder->dssdev = dssdev;
180
181 encoder = &omap_encoder->base;
182
183 drm_encoder_init(dev, encoder, &omap_encoder_funcs,
184 DRM_MODE_ENCODER_TMDS, NULL);
185 drm_encoder_helper_add(encoder, &omap_encoder_helper_funcs);
186
187 return encoder;
188
189fail:
190 if (encoder)
191 omap_encoder_destroy(encoder);
192
193 return NULL;
194}
1/*
2 * Copyright (C) 2011 Texas Instruments Incorporated - http://www.ti.com/
3 * Author: Rob Clark <rob@ti.com>
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License version 2 as published by
7 * the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program. If not, see <http://www.gnu.org/licenses/>.
16 */
17
18#include <linux/list.h>
19
20#include <drm/drm_crtc.h>
21#include <drm/drm_crtc_helper.h>
22#include <drm/drm_edid.h>
23
24#include "omap_drv.h"
25
26/*
27 * encoder funcs
28 */
29
30#define to_omap_encoder(x) container_of(x, struct omap_encoder, base)
31
32/* The encoder and connector both map to same dssdev.. the encoder
33 * handles the 'active' parts, ie. anything the modifies the state
34 * of the hw, and the connector handles the 'read-only' parts, like
35 * detecting connection and reading edid.
36 */
37struct omap_encoder {
38 struct drm_encoder base;
39 struct omap_dss_device *dssdev;
40};
41
42struct omap_dss_device *omap_encoder_get_dssdev(struct drm_encoder *encoder)
43{
44 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
45
46 return omap_encoder->dssdev;
47}
48
49static void omap_encoder_destroy(struct drm_encoder *encoder)
50{
51 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
52
53 drm_encoder_cleanup(encoder);
54 kfree(omap_encoder);
55}
56
57static const struct drm_encoder_funcs omap_encoder_funcs = {
58 .destroy = omap_encoder_destroy,
59};
60
61static void omap_encoder_mode_set(struct drm_encoder *encoder,
62 struct drm_display_mode *mode,
63 struct drm_display_mode *adjusted_mode)
64{
65 struct drm_device *dev = encoder->dev;
66 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
67 struct omap_dss_device *dssdev = omap_encoder->dssdev;
68 struct drm_connector *connector;
69 bool hdmi_mode;
70 int r;
71
72 hdmi_mode = false;
73 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
74 if (connector->encoder == encoder) {
75 hdmi_mode = omap_connector_get_hdmi_mode(connector);
76 break;
77 }
78 }
79
80 if (dssdev->driver->set_hdmi_mode)
81 dssdev->driver->set_hdmi_mode(dssdev, hdmi_mode);
82
83 if (hdmi_mode && dssdev->driver->set_hdmi_infoframe) {
84 struct hdmi_avi_infoframe avi;
85
86 r = drm_hdmi_avi_infoframe_from_display_mode(&avi, adjusted_mode,
87 false);
88 if (r == 0)
89 dssdev->driver->set_hdmi_infoframe(dssdev, &avi);
90 }
91}
92
93static void omap_encoder_disable(struct drm_encoder *encoder)
94{
95 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
96 struct omap_dss_device *dssdev = omap_encoder->dssdev;
97 struct omap_dss_driver *dssdrv = dssdev->driver;
98
99 dssdrv->disable(dssdev);
100}
101
102static int omap_encoder_update(struct drm_encoder *encoder,
103 enum omap_channel channel,
104 struct videomode *vm)
105{
106 struct drm_device *dev = encoder->dev;
107 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
108 struct omap_dss_device *dssdev = omap_encoder->dssdev;
109 struct omap_dss_driver *dssdrv = dssdev->driver;
110 int ret;
111
112 if (dssdrv->check_timings) {
113 ret = dssdrv->check_timings(dssdev, vm);
114 } else {
115 struct videomode t = {0};
116
117 dssdrv->get_timings(dssdev, &t);
118
119 if (memcmp(vm, &t, sizeof(*vm)))
120 ret = -EINVAL;
121 else
122 ret = 0;
123 }
124
125 if (ret) {
126 dev_err(dev->dev, "could not set timings: %d\n", ret);
127 return ret;
128 }
129
130 if (dssdrv->set_timings)
131 dssdrv->set_timings(dssdev, vm);
132
133 return 0;
134}
135
136static void omap_encoder_enable(struct drm_encoder *encoder)
137{
138 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
139 struct omap_dss_device *dssdev = omap_encoder->dssdev;
140 struct omap_dss_driver *dssdrv = dssdev->driver;
141 int r;
142
143 omap_encoder_update(encoder, omap_crtc_channel(encoder->crtc),
144 omap_crtc_timings(encoder->crtc));
145
146 r = dssdrv->enable(dssdev);
147 if (r)
148 dev_err(encoder->dev->dev,
149 "Failed to enable display '%s': %d\n",
150 dssdev->name, r);
151}
152
153static int omap_encoder_atomic_check(struct drm_encoder *encoder,
154 struct drm_crtc_state *crtc_state,
155 struct drm_connector_state *conn_state)
156{
157 return 0;
158}
159
160static const struct drm_encoder_helper_funcs omap_encoder_helper_funcs = {
161 .mode_set = omap_encoder_mode_set,
162 .disable = omap_encoder_disable,
163 .enable = omap_encoder_enable,
164 .atomic_check = omap_encoder_atomic_check,
165};
166
167/* initialize encoder */
168struct drm_encoder *omap_encoder_init(struct drm_device *dev,
169 struct omap_dss_device *dssdev)
170{
171 struct drm_encoder *encoder = NULL;
172 struct omap_encoder *omap_encoder;
173
174 omap_encoder = kzalloc(sizeof(*omap_encoder), GFP_KERNEL);
175 if (!omap_encoder)
176 goto fail;
177
178 omap_encoder->dssdev = dssdev;
179
180 encoder = &omap_encoder->base;
181
182 drm_encoder_init(dev, encoder, &omap_encoder_funcs,
183 DRM_MODE_ENCODER_TMDS, NULL);
184 drm_encoder_helper_add(encoder, &omap_encoder_helper_funcs);
185
186 return encoder;
187
188fail:
189 if (encoder)
190 omap_encoder_destroy(encoder);
191
192 return NULL;
193}