1 /*
2 * R-Car Display Unit HDMI Encoder
3 *
4 * Copyright (C) 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/slab.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_lvdsenc.h"
24
25 struct rcar_du_hdmienc {
26 struct rcar_du_encoder *renc;
27 bool enabled;
28 };
29
30 #define to_rcar_hdmienc(e) (to_rcar_encoder(e)->hdmi)
31
rcar_du_hdmienc_disable(struct drm_encoder * encoder)32 static void rcar_du_hdmienc_disable(struct drm_encoder *encoder)
33 {
34 struct rcar_du_hdmienc *hdmienc = to_rcar_hdmienc(encoder);
35
36 if (hdmienc->renc->lvds)
37 rcar_du_lvdsenc_enable(hdmienc->renc->lvds, encoder->crtc,
38 false);
39
40 hdmienc->enabled = false;
41 }
42
rcar_du_hdmienc_enable(struct drm_encoder * encoder)43 static void rcar_du_hdmienc_enable(struct drm_encoder *encoder)
44 {
45 struct rcar_du_hdmienc *hdmienc = to_rcar_hdmienc(encoder);
46
47 if (hdmienc->renc->lvds)
48 rcar_du_lvdsenc_enable(hdmienc->renc->lvds, encoder->crtc,
49 true);
50
51 hdmienc->enabled = true;
52 }
53
rcar_du_hdmienc_atomic_check(struct drm_encoder * encoder,struct drm_crtc_state * crtc_state,struct drm_connector_state * conn_state)54 static int rcar_du_hdmienc_atomic_check(struct drm_encoder *encoder,
55 struct drm_crtc_state *crtc_state,
56 struct drm_connector_state *conn_state)
57 {
58 struct rcar_du_hdmienc *hdmienc = to_rcar_hdmienc(encoder);
59 struct drm_display_mode *adjusted_mode = &crtc_state->adjusted_mode;
60
61 if (hdmienc->renc->lvds)
62 rcar_du_lvdsenc_atomic_check(hdmienc->renc->lvds,
63 adjusted_mode);
64
65 return 0;
66 }
67
68
rcar_du_hdmienc_mode_set(struct drm_encoder * encoder,struct drm_display_mode * mode,struct drm_display_mode * adjusted_mode)69 static void rcar_du_hdmienc_mode_set(struct drm_encoder *encoder,
70 struct drm_display_mode *mode,
71 struct drm_display_mode *adjusted_mode)
72 {
73 struct rcar_du_hdmienc *hdmienc = to_rcar_hdmienc(encoder);
74
75 rcar_du_crtc_route_output(encoder->crtc, hdmienc->renc->output);
76 }
77
78 static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
79 .mode_set = rcar_du_hdmienc_mode_set,
80 .disable = rcar_du_hdmienc_disable,
81 .enable = rcar_du_hdmienc_enable,
82 .atomic_check = rcar_du_hdmienc_atomic_check,
83 };
84
rcar_du_hdmienc_cleanup(struct drm_encoder * encoder)85 static void rcar_du_hdmienc_cleanup(struct drm_encoder *encoder)
86 {
87 struct rcar_du_hdmienc *hdmienc = to_rcar_hdmienc(encoder);
88
89 if (hdmienc->enabled)
90 rcar_du_hdmienc_disable(encoder);
91
92 drm_encoder_cleanup(encoder);
93 }
94
95 static const struct drm_encoder_funcs encoder_funcs = {
96 .destroy = rcar_du_hdmienc_cleanup,
97 };
98
rcar_du_hdmienc_init(struct rcar_du_device * rcdu,struct rcar_du_encoder * renc,struct device_node * np)99 int rcar_du_hdmienc_init(struct rcar_du_device *rcdu,
100 struct rcar_du_encoder *renc, struct device_node *np)
101 {
102 struct drm_encoder *encoder = rcar_encoder_to_drm_encoder(renc);
103 struct drm_bridge *bridge;
104 struct rcar_du_hdmienc *hdmienc;
105 int ret;
106
107 hdmienc = devm_kzalloc(rcdu->dev, sizeof(*hdmienc), GFP_KERNEL);
108 if (hdmienc == NULL)
109 return -ENOMEM;
110
111 /* Locate drm bridge from the hdmi encoder DT node */
112 bridge = of_drm_find_bridge(np);
113 if (!bridge)
114 return -EPROBE_DEFER;
115
116 ret = drm_encoder_init(rcdu->ddev, encoder, &encoder_funcs,
117 DRM_MODE_ENCODER_TMDS, NULL);
118 if (ret < 0)
119 return ret;
120
121 drm_encoder_helper_add(encoder, &encoder_helper_funcs);
122
123 renc->hdmi = hdmienc;
124 hdmienc->renc = renc;
125
126 /* Link drm_bridge to encoder */
127 bridge->encoder = encoder;
128 encoder->bridge = bridge;
129
130 ret = drm_bridge_attach(rcdu->ddev, bridge);
131 if (ret) {
132 drm_encoder_cleanup(encoder);
133 return ret;
134 }
135
136 return 0;
137 }
138