2 * R-Car Display Unit HDMI Encoder
4 * Copyright (C) 2014 Renesas Electronics Corporation
6 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
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.
14 #include <linux/slab.h>
17 #include <drm/drm_crtc.h>
18 #include <drm/drm_crtc_helper.h>
19 #include <drm/drm_encoder_slave.h>
21 #include "rcar_du_drv.h"
22 #include "rcar_du_encoder.h"
23 #include "rcar_du_hdmienc.h"
25 struct rcar_du_hdmienc {
26 struct rcar_du_encoder *renc;
31 #define to_rcar_hdmienc(e) (to_rcar_encoder(e)->hdmi)
32 #define to_slave_funcs(e) (to_rcar_encoder(e)->slave.slave_funcs)
34 static void rcar_du_hdmienc_dpms(struct drm_encoder *encoder, int mode)
36 struct rcar_du_hdmienc *hdmienc = to_rcar_hdmienc(encoder);
37 struct drm_encoder_slave_funcs *sfuncs = to_slave_funcs(encoder);
39 if (hdmienc->dpms == mode)
43 sfuncs->dpms(encoder, mode);
48 static bool rcar_du_hdmienc_mode_fixup(struct drm_encoder *encoder,
49 const struct drm_display_mode *mode,
50 struct drm_display_mode *adjusted_mode)
52 struct drm_encoder_slave_funcs *sfuncs = to_slave_funcs(encoder);
54 if (sfuncs->mode_fixup == NULL)
57 return sfuncs->mode_fixup(encoder, mode, adjusted_mode);
60 static void rcar_du_hdmienc_mode_prepare(struct drm_encoder *encoder)
62 rcar_du_hdmienc_dpms(encoder, DRM_MODE_DPMS_OFF);
65 static void rcar_du_hdmienc_mode_commit(struct drm_encoder *encoder)
67 rcar_du_hdmienc_dpms(encoder, DRM_MODE_DPMS_ON);
70 static void rcar_du_hdmienc_mode_set(struct drm_encoder *encoder,
71 struct drm_display_mode *mode,
72 struct drm_display_mode *adjusted_mode)
74 struct rcar_du_hdmienc *hdmienc = to_rcar_hdmienc(encoder);
75 struct drm_encoder_slave_funcs *sfuncs = to_slave_funcs(encoder);
78 sfuncs->mode_set(encoder, mode, adjusted_mode);
80 rcar_du_crtc_route_output(encoder->crtc, hdmienc->renc->output);
83 static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
84 .dpms = rcar_du_hdmienc_dpms,
85 .mode_fixup = rcar_du_hdmienc_mode_fixup,
86 .prepare = rcar_du_hdmienc_mode_prepare,
87 .commit = rcar_du_hdmienc_mode_commit,
88 .mode_set = rcar_du_hdmienc_mode_set,
91 static void rcar_du_hdmienc_cleanup(struct drm_encoder *encoder)
93 struct rcar_du_hdmienc *hdmienc = to_rcar_hdmienc(encoder);
95 rcar_du_hdmienc_dpms(encoder, DRM_MODE_DPMS_OFF);
97 drm_encoder_cleanup(encoder);
98 put_device(hdmienc->dev);
101 static const struct drm_encoder_funcs encoder_funcs = {
102 .destroy = rcar_du_hdmienc_cleanup,
105 int rcar_du_hdmienc_init(struct rcar_du_device *rcdu,
106 struct rcar_du_encoder *renc, struct device_node *np)
108 struct drm_encoder *encoder = rcar_encoder_to_drm_encoder(renc);
109 struct drm_i2c_encoder_driver *driver;
110 struct i2c_client *i2c_slave;
111 struct rcar_du_hdmienc *hdmienc;
114 hdmienc = devm_kzalloc(rcdu->dev, sizeof(*hdmienc), GFP_KERNEL);
118 /* Locate the slave I2C device and driver. */
119 i2c_slave = of_find_i2c_device_by_node(np);
120 if (!i2c_slave || !i2c_get_clientdata(i2c_slave))
121 return -EPROBE_DEFER;
123 hdmienc->dev = &i2c_slave->dev;
125 if (hdmienc->dev->driver == NULL) {
130 /* Initialize the slave encoder. */
131 driver = to_drm_i2c_encoder_driver(to_i2c_driver(hdmienc->dev->driver));
132 ret = driver->encoder_init(i2c_slave, rcdu->ddev, &renc->slave);
136 ret = drm_encoder_init(rcdu->ddev, encoder, &encoder_funcs,
137 DRM_MODE_ENCODER_TMDS);
141 drm_encoder_helper_add(encoder, &encoder_helper_funcs);
143 renc->hdmi = hdmienc;
144 hdmienc->renc = renc;
149 put_device(hdmienc->dev);