1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) 2011 Texas Instruments Incorporated - https://www.ti.com/
4 * Author: Rob Clark <rob@ti.com>
5 */
6
7 #include <linux/list.h>
8
9 #include <drm/drm_bridge.h>
10 #include <drm/drm_crtc.h>
11 #include <drm/drm_modeset_helper_vtables.h>
12 #include <drm/drm_edid.h>
13
14 #include "omap_drv.h"
15
16 /*
17 * encoder funcs
18 */
19
20 #define to_omap_encoder(x) container_of(x, struct omap_encoder, base)
21
22 /* The encoder and connector both map to same dssdev.. the encoder
23 * handles the 'active' parts, ie. anything the modifies the state
24 * of the hw, and the connector handles the 'read-only' parts, like
25 * detecting connection and reading edid.
26 */
27 struct omap_encoder {
28 struct drm_encoder base;
29 struct omap_dss_device *output;
30 };
31
omap_encoder_destroy(struct drm_encoder * encoder)32 static void omap_encoder_destroy(struct drm_encoder *encoder)
33 {
34 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
35
36 drm_encoder_cleanup(encoder);
37 kfree(omap_encoder);
38 }
39
40 static const struct drm_encoder_funcs omap_encoder_funcs = {
41 .destroy = omap_encoder_destroy,
42 };
43
omap_encoder_update_videomode_flags(struct videomode * vm,u32 bus_flags)44 static void omap_encoder_update_videomode_flags(struct videomode *vm,
45 u32 bus_flags)
46 {
47 if (!(vm->flags & (DISPLAY_FLAGS_DE_LOW |
48 DISPLAY_FLAGS_DE_HIGH))) {
49 if (bus_flags & DRM_BUS_FLAG_DE_LOW)
50 vm->flags |= DISPLAY_FLAGS_DE_LOW;
51 else if (bus_flags & DRM_BUS_FLAG_DE_HIGH)
52 vm->flags |= DISPLAY_FLAGS_DE_HIGH;
53 }
54
55 if (!(vm->flags & (DISPLAY_FLAGS_PIXDATA_POSEDGE |
56 DISPLAY_FLAGS_PIXDATA_NEGEDGE))) {
57 if (bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_POSEDGE)
58 vm->flags |= DISPLAY_FLAGS_PIXDATA_POSEDGE;
59 else if (bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE)
60 vm->flags |= DISPLAY_FLAGS_PIXDATA_NEGEDGE;
61 }
62
63 if (!(vm->flags & (DISPLAY_FLAGS_SYNC_POSEDGE |
64 DISPLAY_FLAGS_SYNC_NEGEDGE))) {
65 if (bus_flags & DRM_BUS_FLAG_SYNC_DRIVE_POSEDGE)
66 vm->flags |= DISPLAY_FLAGS_SYNC_POSEDGE;
67 else if (bus_flags & DRM_BUS_FLAG_SYNC_DRIVE_NEGEDGE)
68 vm->flags |= DISPLAY_FLAGS_SYNC_NEGEDGE;
69 }
70 }
71
omap_encoder_mode_set(struct drm_encoder * encoder,struct drm_display_mode * mode,struct drm_display_mode * adjusted_mode)72 static void omap_encoder_mode_set(struct drm_encoder *encoder,
73 struct drm_display_mode *mode,
74 struct drm_display_mode *adjusted_mode)
75 {
76 struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
77 struct omap_dss_device *output = omap_encoder->output;
78 struct drm_device *dev = encoder->dev;
79 struct drm_connector *connector;
80 struct videomode vm = { 0 };
81 u32 bus_flags;
82
83 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
84 if (connector->encoder == encoder)
85 break;
86 }
87
88 drm_display_mode_to_videomode(adjusted_mode, &vm);
89
90 /*
91 * HACK: This fixes the vm flags.
92 * struct drm_display_mode does not contain the VSYNC/HSYNC/DE flags and
93 * they get lost when converting back and forth between struct
94 * drm_display_mode and struct videomode. The hack below goes and
95 * fetches the missing flags.
96 *
97 * A better solution is to use DRM's bus-flags through the whole driver.
98 */
99 drm_for_each_bridge_in_chain_from(output->bridge, bridge) {
100 if (!bridge->timings)
101 continue;
102
103 bus_flags = bridge->timings->input_bus_flags;
104 omap_encoder_update_videomode_flags(&vm, bus_flags);
105 }
106
107 bus_flags = connector->display_info.bus_flags;
108 omap_encoder_update_videomode_flags(&vm, bus_flags);
109
110 /* Set timings for all devices in the display pipeline. */
111 dss_mgr_set_timings(output, &vm);
112 }
113
114 static const struct drm_encoder_helper_funcs omap_encoder_helper_funcs = {
115 .mode_set = omap_encoder_mode_set,
116 };
117
118 /* initialize encoder */
omap_encoder_init(struct drm_device * dev,struct omap_dss_device * output)119 struct drm_encoder *omap_encoder_init(struct drm_device *dev,
120 struct omap_dss_device *output)
121 {
122 struct drm_encoder *encoder = NULL;
123 struct omap_encoder *omap_encoder;
124
125 omap_encoder = kzalloc_obj(*omap_encoder);
126 if (!omap_encoder)
127 goto fail;
128
129 omap_encoder->output = output;
130
131 encoder = &omap_encoder->base;
132
133 drm_encoder_init(dev, encoder, &omap_encoder_funcs,
134 DRM_MODE_ENCODER_TMDS, NULL);
135 drm_encoder_helper_add(encoder, &omap_encoder_helper_funcs);
136
137 return encoder;
138
139 fail:
140 if (encoder)
141 omap_encoder_destroy(encoder);
142
143 return NULL;
144 }
145