Loading...
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * rcar_du_encoder.c -- R-Car Display Unit Encoder
4 *
5 * Copyright (C) 2013-2014 Renesas Electronics Corporation
6 *
7 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
8 */
9
10#include <linux/export.h>
11
12#include <drm/drm_crtc.h>
13#include <drm/drm_modeset_helper_vtables.h>
14#include <drm/drm_panel.h>
15
16#include "rcar_du_drv.h"
17#include "rcar_du_encoder.h"
18#include "rcar_du_kms.h"
19#include "rcar_lvds.h"
20
21/* -----------------------------------------------------------------------------
22 * Encoder
23 */
24
25static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
26};
27
28static const struct drm_encoder_funcs encoder_funcs = {
29 .destroy = drm_encoder_cleanup,
30};
31
32static unsigned int rcar_du_encoder_count_ports(struct device_node *node)
33{
34 struct device_node *ports;
35 struct device_node *port;
36 unsigned int num_ports = 0;
37
38 ports = of_get_child_by_name(node, "ports");
39 if (!ports)
40 ports = of_node_get(node);
41
42 for_each_child_of_node(ports, port) {
43 if (of_node_name_eq(port, "port"))
44 num_ports++;
45 }
46
47 of_node_put(ports);
48
49 return num_ports;
50}
51
52int rcar_du_encoder_init(struct rcar_du_device *rcdu,
53 enum rcar_du_output output,
54 struct device_node *enc_node)
55{
56 struct rcar_du_encoder *renc;
57 struct drm_encoder *encoder;
58 struct drm_bridge *bridge;
59 int ret;
60
61 renc = devm_kzalloc(rcdu->dev, sizeof(*renc), GFP_KERNEL);
62 if (renc == NULL)
63 return -ENOMEM;
64
65 rcdu->encoders[output] = renc;
66 renc->output = output;
67 encoder = rcar_encoder_to_drm_encoder(renc);
68
69 dev_dbg(rcdu->dev, "initializing encoder %pOF for output %u\n",
70 enc_node, output);
71
72 /*
73 * Locate the DRM bridge from the DT node. For the DPAD outputs, if the
74 * DT node has a single port, assume that it describes a panel and
75 * create a panel bridge.
76 */
77 if ((output == RCAR_DU_OUTPUT_DPAD0 ||
78 output == RCAR_DU_OUTPUT_DPAD1) &&
79 rcar_du_encoder_count_ports(enc_node) == 1) {
80 struct drm_panel *panel = of_drm_find_panel(enc_node);
81
82 if (IS_ERR(panel)) {
83 ret = PTR_ERR(panel);
84 goto done;
85 }
86
87 bridge = devm_drm_panel_bridge_add(rcdu->dev, panel,
88 DRM_MODE_CONNECTOR_DPI);
89 if (IS_ERR(bridge)) {
90 ret = PTR_ERR(bridge);
91 goto done;
92 }
93 } else {
94 bridge = of_drm_find_bridge(enc_node);
95 if (!bridge) {
96 ret = -EPROBE_DEFER;
97 goto done;
98 }
99 }
100
101 /*
102 * On Gen3 skip the LVDS1 output if the LVDS1 encoder is used as a
103 * companion for LVDS0 in dual-link mode.
104 */
105 if (rcdu->info->gen >= 3 && output == RCAR_DU_OUTPUT_LVDS1) {
106 if (rcar_lvds_dual_link(bridge)) {
107 ret = -ENOLINK;
108 goto done;
109 }
110 }
111
112 ret = drm_encoder_init(rcdu->ddev, encoder, &encoder_funcs,
113 DRM_MODE_ENCODER_NONE, NULL);
114 if (ret < 0)
115 goto done;
116
117 drm_encoder_helper_add(encoder, &encoder_helper_funcs);
118
119 /*
120 * Attach the bridge to the encoder. The bridge will create the
121 * connector.
122 */
123 ret = drm_bridge_attach(encoder, bridge, NULL);
124 if (ret) {
125 drm_encoder_cleanup(encoder);
126 return ret;
127 }
128
129done:
130 if (ret < 0) {
131 if (encoder->name)
132 encoder->funcs->destroy(encoder);
133 devm_kfree(rcdu->dev, renc);
134 }
135
136 return ret;
137}
1/*
2 * rcar_du_encoder.c -- R-Car Display Unit Encoder
3 *
4 * Copyright (C) 2013-2014 Renesas Electronics Corporation
5 *
6 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 */
13
14#include <linux/export.h>
15
16#include <drm/drmP.h>
17#include <drm/drm_crtc.h>
18#include <drm/drm_crtc_helper.h>
19
20#include "rcar_du_drv.h"
21#include "rcar_du_encoder.h"
22#include "rcar_du_hdmienc.h"
23#include "rcar_du_kms.h"
24#include "rcar_du_lvdscon.h"
25#include "rcar_du_lvdsenc.h"
26#include "rcar_du_vgacon.h"
27
28/* -----------------------------------------------------------------------------
29 * Encoder
30 */
31
32static void rcar_du_encoder_disable(struct drm_encoder *encoder)
33{
34 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
35
36 if (renc->lvds)
37 rcar_du_lvdsenc_enable(renc->lvds, encoder->crtc, false);
38}
39
40static void rcar_du_encoder_enable(struct drm_encoder *encoder)
41{
42 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
43
44 if (renc->lvds)
45 rcar_du_lvdsenc_enable(renc->lvds, encoder->crtc, true);
46}
47
48static int rcar_du_encoder_atomic_check(struct drm_encoder *encoder,
49 struct drm_crtc_state *crtc_state,
50 struct drm_connector_state *conn_state)
51{
52 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
53 struct drm_display_mode *adjusted_mode = &crtc_state->adjusted_mode;
54 const struct drm_display_mode *mode = &crtc_state->mode;
55 const struct drm_display_mode *panel_mode;
56 struct drm_connector *connector = conn_state->connector;
57 struct drm_device *dev = encoder->dev;
58
59 /* DAC encoders have currently no restriction on the mode. */
60 if (encoder->encoder_type == DRM_MODE_ENCODER_DAC)
61 return 0;
62
63 if (list_empty(&connector->modes)) {
64 dev_dbg(dev->dev, "encoder: empty modes list\n");
65 return -EINVAL;
66 }
67
68 panel_mode = list_first_entry(&connector->modes,
69 struct drm_display_mode, head);
70
71 /* We're not allowed to modify the resolution. */
72 if (mode->hdisplay != panel_mode->hdisplay ||
73 mode->vdisplay != panel_mode->vdisplay)
74 return -EINVAL;
75
76 /* The flat panel mode is fixed, just copy it to the adjusted mode. */
77 drm_mode_copy(adjusted_mode, panel_mode);
78
79 if (renc->lvds)
80 rcar_du_lvdsenc_atomic_check(renc->lvds, adjusted_mode);
81
82 return 0;
83}
84
85static void rcar_du_encoder_mode_set(struct drm_encoder *encoder,
86 struct drm_display_mode *mode,
87 struct drm_display_mode *adjusted_mode)
88{
89 struct rcar_du_encoder *renc = to_rcar_encoder(encoder);
90
91 rcar_du_crtc_route_output(encoder->crtc, renc->output);
92}
93
94static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
95 .mode_set = rcar_du_encoder_mode_set,
96 .disable = rcar_du_encoder_disable,
97 .enable = rcar_du_encoder_enable,
98 .atomic_check = rcar_du_encoder_atomic_check,
99};
100
101static const struct drm_encoder_funcs encoder_funcs = {
102 .destroy = drm_encoder_cleanup,
103};
104
105int rcar_du_encoder_init(struct rcar_du_device *rcdu,
106 enum rcar_du_encoder_type type,
107 enum rcar_du_output output,
108 struct device_node *enc_node,
109 struct device_node *con_node)
110{
111 struct rcar_du_encoder *renc;
112 struct drm_encoder *encoder;
113 unsigned int encoder_type;
114 int ret;
115
116 renc = devm_kzalloc(rcdu->dev, sizeof(*renc), GFP_KERNEL);
117 if (renc == NULL)
118 return -ENOMEM;
119
120 renc->output = output;
121 encoder = rcar_encoder_to_drm_encoder(renc);
122
123 switch (output) {
124 case RCAR_DU_OUTPUT_LVDS0:
125 renc->lvds = rcdu->lvds[0];
126 break;
127
128 case RCAR_DU_OUTPUT_LVDS1:
129 renc->lvds = rcdu->lvds[1];
130 break;
131
132 default:
133 break;
134 }
135
136 switch (type) {
137 case RCAR_DU_ENCODER_VGA:
138 encoder_type = DRM_MODE_ENCODER_DAC;
139 break;
140 case RCAR_DU_ENCODER_LVDS:
141 encoder_type = DRM_MODE_ENCODER_LVDS;
142 break;
143 case RCAR_DU_ENCODER_HDMI:
144 encoder_type = DRM_MODE_ENCODER_TMDS;
145 break;
146 case RCAR_DU_ENCODER_NONE:
147 default:
148 /* No external encoder, use the internal encoder type. */
149 encoder_type = rcdu->info->routes[output].encoder_type;
150 break;
151 }
152
153 if (type == RCAR_DU_ENCODER_HDMI) {
154 ret = rcar_du_hdmienc_init(rcdu, renc, enc_node);
155 if (ret < 0)
156 goto done;
157 } else {
158 ret = drm_encoder_init(rcdu->ddev, encoder, &encoder_funcs,
159 encoder_type, NULL);
160 if (ret < 0)
161 goto done;
162
163 drm_encoder_helper_add(encoder, &encoder_helper_funcs);
164 }
165
166 switch (encoder_type) {
167 case DRM_MODE_ENCODER_LVDS:
168 ret = rcar_du_lvds_connector_init(rcdu, renc, con_node);
169 break;
170
171 case DRM_MODE_ENCODER_DAC:
172 ret = rcar_du_vga_connector_init(rcdu, renc);
173 break;
174
175 case DRM_MODE_ENCODER_TMDS:
176 /* connector managed by the bridge driver */
177 break;
178
179 default:
180 ret = -EINVAL;
181 break;
182 }
183
184done:
185 if (ret < 0) {
186 if (encoder->name)
187 encoder->funcs->destroy(encoder);
188 devm_kfree(rcdu->dev, renc);
189 }
190
191 return ret;
192}