1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2018 Texas Instruments Incorporated - https://www.ti.com/
4 * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
5 */
6
7 #include <linux/export.h>
8
9 #include <drm/drm_atomic_helper.h>
10 #include <drm/drm_bridge.h>
11 #include <drm/drm_bridge_connector.h>
12 #include <drm/drm_crtc.h>
13 #include <drm/drm_modeset_helper_vtables.h>
14 #include <drm/drm_panel.h>
15 #include <drm/drm_of.h>
16 #include <drm/drm_simple_kms_helper.h>
17
18 #include "tidss_crtc.h"
19 #include "tidss_drv.h"
20 #include "tidss_encoder.h"
21
22 struct tidss_encoder {
23 struct drm_bridge bridge;
24 struct drm_encoder encoder;
25 struct drm_connector *connector;
26 struct drm_bridge *next_bridge;
27 struct tidss_device *tidss;
28 };
29
30 static inline struct tidss_encoder
bridge_to_tidss_encoder(struct drm_bridge * b)31 *bridge_to_tidss_encoder(struct drm_bridge *b)
32 {
33 return container_of(b, struct tidss_encoder, bridge);
34 }
35
tidss_bridge_attach(struct drm_bridge * bridge,struct drm_encoder * encoder,enum drm_bridge_attach_flags flags)36 static int tidss_bridge_attach(struct drm_bridge *bridge,
37 struct drm_encoder *encoder,
38 enum drm_bridge_attach_flags flags)
39 {
40 struct tidss_encoder *t_enc = bridge_to_tidss_encoder(bridge);
41
42 return drm_bridge_attach(encoder, t_enc->next_bridge,
43 bridge, flags);
44 }
45
tidss_bridge_atomic_check(struct drm_bridge * bridge,struct drm_bridge_state * bridge_state,struct drm_crtc_state * crtc_state,struct drm_connector_state * conn_state)46 static int tidss_bridge_atomic_check(struct drm_bridge *bridge,
47 struct drm_bridge_state *bridge_state,
48 struct drm_crtc_state *crtc_state,
49 struct drm_connector_state *conn_state)
50 {
51 struct tidss_encoder *t_enc = bridge_to_tidss_encoder(bridge);
52 struct tidss_device *tidss = t_enc->tidss;
53 struct tidss_crtc_state *tcrtc_state = to_tidss_crtc_state(crtc_state);
54 struct drm_display_info *di = &conn_state->connector->display_info;
55 struct drm_bridge_state *next_bridge_state = NULL;
56
57 if (t_enc->next_bridge)
58 next_bridge_state = drm_atomic_get_new_bridge_state(crtc_state->state,
59 t_enc->next_bridge);
60
61 if (next_bridge_state) {
62 tcrtc_state->bus_flags = next_bridge_state->input_bus_cfg.flags;
63 tcrtc_state->bus_format = next_bridge_state->input_bus_cfg.format;
64 } else if (di->num_bus_formats) {
65 tcrtc_state->bus_format = di->bus_formats[0];
66 tcrtc_state->bus_flags = di->bus_flags;
67 } else {
68 dev_err(tidss->dev, "%s: No bus_formats in connected display\n",
69 __func__);
70 return -EINVAL;
71 }
72
73 return 0;
74 }
75
76 static const struct drm_bridge_funcs tidss_bridge_funcs = {
77 .attach = tidss_bridge_attach,
78 .atomic_check = tidss_bridge_atomic_check,
79 .atomic_reset = drm_atomic_helper_bridge_reset,
80 .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
81 .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
82 };
83
tidss_encoder_create(struct tidss_device * tidss,struct drm_bridge * next_bridge,u32 encoder_type,u32 possible_crtcs)84 int tidss_encoder_create(struct tidss_device *tidss,
85 struct drm_bridge *next_bridge,
86 u32 encoder_type, u32 possible_crtcs)
87 {
88 struct tidss_encoder *t_enc;
89 struct drm_encoder *enc;
90 struct drm_connector *connector;
91 int ret;
92
93 t_enc = devm_drm_bridge_alloc(tidss->dev, struct tidss_encoder,
94 bridge, &tidss_bridge_funcs);
95 if (IS_ERR(t_enc))
96 return PTR_ERR(t_enc);
97
98 ret = drm_simple_encoder_init(&tidss->ddev, &t_enc->encoder,
99 encoder_type);
100 if (ret)
101 return ret;
102
103 t_enc->tidss = tidss;
104 t_enc->next_bridge = next_bridge;
105
106 enc = &t_enc->encoder;
107 enc->possible_crtcs = possible_crtcs;
108
109 /* Attaching first bridge to the encoder */
110 ret = drm_bridge_attach(enc, &t_enc->bridge, NULL,
111 DRM_BRIDGE_ATTACH_NO_CONNECTOR);
112 if (ret) {
113 dev_err(tidss->dev, "bridge attach failed: %d\n", ret);
114 return ret;
115 }
116
117 /* Initializing the connector at the end of bridge-chain */
118 connector = drm_bridge_connector_init(&tidss->ddev, enc);
119 if (IS_ERR(connector)) {
120 dev_err(tidss->dev, "bridge_connector create failed\n");
121 return PTR_ERR(connector);
122 }
123
124 ret = drm_connector_attach_encoder(connector, enc);
125 if (ret) {
126 dev_err(tidss->dev, "attaching encoder to connector failed\n");
127 return ret;
128 }
129
130 t_enc->connector = connector;
131
132 dev_dbg(tidss->dev, "Encoder create done\n");
133
134 return ret;
135 }
136