1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (c) 2020 Rockchip Electronics Co., Ltd.
4 *
5 * Author: Zhang Yubing <yubing.zhang@rock-chips.com>
6 * Author: Andy Yan <andy.yan@rock-chips.com>
7 */
8
9 #include <linux/component.h>
10 #include <linux/of_device.h>
11 #include <linux/platform_device.h>
12 #include <drm/bridge/dw_dp.h>
13 #include <drm/drm_atomic_helper.h>
14 #include <drm/drm_bridge.h>
15 #include <drm/drm_bridge_connector.h>
16 #include <drm/drm_of.h>
17 #include <drm/drm_print.h>
18 #include <drm/drm_probe_helper.h>
19 #include <drm/drm_simple_kms_helper.h>
20
21 #include <linux/media-bus-format.h>
22 #include <linux/videodev2.h>
23
24 #include "rockchip_drm_drv.h"
25 #include "rockchip_drm_vop.h"
26
27 struct rockchip_dw_dp {
28 struct dw_dp *base;
29 struct device *dev;
30 struct rockchip_encoder encoder;
31 };
32
dw_dp_encoder_atomic_check(struct drm_encoder * encoder,struct drm_crtc_state * crtc_state,struct drm_connector_state * conn_state)33 static int dw_dp_encoder_atomic_check(struct drm_encoder *encoder,
34 struct drm_crtc_state *crtc_state,
35 struct drm_connector_state *conn_state)
36 {
37 struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state);
38 struct drm_atomic_state *state = conn_state->state;
39 struct drm_display_info *di = &conn_state->connector->display_info;
40 struct drm_bridge *bridge = drm_bridge_chain_get_first_bridge(encoder);
41 struct drm_bridge_state *bridge_state = drm_atomic_get_new_bridge_state(state, bridge);
42 u32 bus_format = bridge_state->input_bus_cfg.format;
43
44 switch (bus_format) {
45 case MEDIA_BUS_FMT_UYYVYY10_0_5X30:
46 case MEDIA_BUS_FMT_UYYVYY8_0_5X24:
47 s->output_mode = ROCKCHIP_OUT_MODE_YUV420;
48 break;
49 case MEDIA_BUS_FMT_YUYV10_1X20:
50 case MEDIA_BUS_FMT_YUYV8_1X16:
51 s->output_mode = ROCKCHIP_OUT_MODE_S888_DUMMY;
52 break;
53 case MEDIA_BUS_FMT_RGB101010_1X30:
54 case MEDIA_BUS_FMT_RGB888_1X24:
55 case MEDIA_BUS_FMT_RGB666_1X24_CPADHI:
56 case MEDIA_BUS_FMT_YUV10_1X30:
57 case MEDIA_BUS_FMT_YUV8_1X24:
58 default:
59 s->output_mode = ROCKCHIP_OUT_MODE_AAAA;
60 break;
61 }
62
63 s->output_type = DRM_MODE_CONNECTOR_DisplayPort;
64 s->bus_format = bus_format;
65 s->bus_flags = di->bus_flags;
66 s->color_space = V4L2_COLORSPACE_DEFAULT;
67
68 return 0;
69 }
70
71 static const struct drm_encoder_helper_funcs dw_dp_encoder_helper_funcs = {
72 .atomic_check = dw_dp_encoder_atomic_check,
73 };
74
dw_dp_rockchip_bind(struct device * dev,struct device * master,void * data)75 static int dw_dp_rockchip_bind(struct device *dev, struct device *master, void *data)
76 {
77 struct platform_device *pdev = to_platform_device(dev);
78 struct dw_dp_plat_data plat_data;
79 struct drm_device *drm_dev = data;
80 struct rockchip_dw_dp *dp;
81 struct drm_encoder *encoder;
82 struct drm_connector *connector;
83 int ret;
84
85 dp = devm_kzalloc(dev, sizeof(*dp), GFP_KERNEL);
86 if (!dp)
87 return -ENOMEM;
88
89 dp->dev = dev;
90 platform_set_drvdata(pdev, dp);
91
92 plat_data.max_link_rate = 810000;
93 encoder = &dp->encoder.encoder;
94 encoder->possible_crtcs = drm_of_find_possible_crtcs(drm_dev, dev->of_node);
95 rockchip_drm_encoder_set_crtc_endpoint_id(&dp->encoder, dev->of_node, 0, 0);
96
97 ret = drmm_encoder_init(drm_dev, encoder, NULL, DRM_MODE_ENCODER_TMDS, NULL);
98 if (ret)
99 return ret;
100 drm_encoder_helper_add(encoder, &dw_dp_encoder_helper_funcs);
101
102 dp->base = dw_dp_bind(dev, encoder, &plat_data);
103 if (IS_ERR(dp->base)) {
104 ret = PTR_ERR(dp->base);
105 return ret;
106 }
107
108 connector = drm_bridge_connector_init(drm_dev, encoder);
109 if (IS_ERR(connector)) {
110 ret = PTR_ERR(connector);
111 return dev_err_probe(dev, ret, "Failed to init bridge connector");
112 }
113
114 drm_connector_attach_encoder(connector, encoder);
115
116 return 0;
117 }
118
119 static const struct component_ops dw_dp_rockchip_component_ops = {
120 .bind = dw_dp_rockchip_bind,
121 };
122
dw_dp_probe(struct platform_device * pdev)123 static int dw_dp_probe(struct platform_device *pdev)
124 {
125 struct device *dev = &pdev->dev;
126
127 return component_add(dev, &dw_dp_rockchip_component_ops);
128 }
129
dw_dp_remove(struct platform_device * pdev)130 static void dw_dp_remove(struct platform_device *pdev)
131 {
132 struct rockchip_dw_dp *dp = platform_get_drvdata(pdev);
133
134 component_del(dp->dev, &dw_dp_rockchip_component_ops);
135 }
136
137 static const struct of_device_id dw_dp_of_match[] = {
138 { .compatible = "rockchip,rk3588-dp", },
139 {}
140 };
141 MODULE_DEVICE_TABLE(of, dw_dp_of_match);
142
143 struct platform_driver dw_dp_driver = {
144 .probe = dw_dp_probe,
145 .remove = dw_dp_remove,
146 .driver = {
147 .name = "dw-dp",
148 .of_match_table = dw_dp_of_match,
149 },
150 };
151