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/media-bus-format.h> 11 #include <linux/of_device.h> 12 #include <linux/platform_device.h> 13 #include <linux/videodev2.h> 14 15 #include <drm/bridge/dw_dp.h> 16 #include <drm/drm_atomic_helper.h> 17 #include <drm/drm_bridge.h> 18 #include <drm/drm_bridge_connector.h> 19 #include <drm/drm_managed.h> 20 #include <drm/drm_of.h> 21 #include <drm/drm_print.h> 22 #include <drm/drm_probe_helper.h> 23 24 #include "rockchip_drm_drv.h" 25 26 struct rockchip_dw_dp { 27 struct dw_dp *base; 28 struct device *dev; 29 struct rockchip_encoder encoder; 30 }; 31 32 static int dw_dp_encoder_atomic_check(struct drm_encoder *encoder, 33 struct drm_crtc_state *crtc_state, 34 struct drm_connector_state *conn_state) 35 { 36 struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state); 37 struct drm_atomic_commit *state = conn_state->state; 38 struct drm_display_info *di = &conn_state->connector->display_info; 39 struct drm_bridge *bridge = drm_bridge_chain_get_first_bridge(encoder); 40 struct drm_bridge_state *bridge_state = drm_atomic_get_new_bridge_state(state, bridge); 41 u32 bus_format = bridge_state->input_bus_cfg.format; 42 43 switch (bus_format) { 44 case MEDIA_BUS_FMT_UYYVYY10_0_5X30: 45 case MEDIA_BUS_FMT_UYYVYY8_0_5X24: 46 s->output_mode = ROCKCHIP_OUT_MODE_YUV420; 47 break; 48 case MEDIA_BUS_FMT_YUYV10_1X20: 49 case MEDIA_BUS_FMT_YUYV8_1X16: 50 s->output_mode = ROCKCHIP_OUT_MODE_S888_DUMMY; 51 break; 52 case MEDIA_BUS_FMT_RGB101010_1X30: 53 case MEDIA_BUS_FMT_RGB888_1X24: 54 case MEDIA_BUS_FMT_RGB666_1X24_CPADHI: 55 case MEDIA_BUS_FMT_YUV10_1X30: 56 case MEDIA_BUS_FMT_YUV8_1X24: 57 default: 58 s->output_mode = ROCKCHIP_OUT_MODE_AAAA; 59 break; 60 } 61 62 s->output_type = DRM_MODE_CONNECTOR_DisplayPort; 63 s->bus_format = bus_format; 64 s->bus_flags = di->bus_flags; 65 s->color_space = V4L2_COLORSPACE_DEFAULT; 66 67 return 0; 68 } 69 70 static const struct drm_encoder_helper_funcs dw_dp_encoder_helper_funcs = { 71 .atomic_check = dw_dp_encoder_atomic_check, 72 }; 73 74 static int dw_dp_rockchip_bind(struct device *dev, struct device *master, void *data) 75 { 76 struct platform_device *pdev = to_platform_device(dev); 77 const struct dw_dp_plat_data *plat_data; 78 struct drm_device *drm_dev = data; 79 struct rockchip_dw_dp *dp; 80 struct drm_encoder *encoder; 81 struct drm_connector *connector; 82 int ret; 83 84 dp = drmm_kzalloc(drm_dev, sizeof(*dp), GFP_KERNEL); 85 if (!dp) 86 return -ENOMEM; 87 88 dp->dev = dev; 89 platform_set_drvdata(pdev, dp); 90 91 plat_data = of_device_get_match_data(dev); 92 if (!plat_data) 93 return -ENODEV; 94 95 encoder = &dp->encoder.encoder; 96 encoder->possible_crtcs = drm_of_find_possible_crtcs(drm_dev, dev->of_node); 97 rockchip_drm_encoder_set_crtc_endpoint_id(&dp->encoder, dev->of_node, 0, 0); 98 99 ret = drmm_encoder_init(drm_dev, encoder, NULL, DRM_MODE_ENCODER_TMDS, NULL); 100 if (ret) 101 return ret; 102 drm_encoder_helper_add(encoder, &dw_dp_encoder_helper_funcs); 103 104 dp->base = dw_dp_bind(dev, encoder, plat_data); 105 if (IS_ERR(dp->base)) 106 return PTR_ERR(dp->base); 107 108 connector = drm_bridge_connector_init(drm_dev, encoder); 109 if (IS_ERR(connector)) { 110 dw_dp_unbind(dp->base); 111 return dev_err_probe(dev, PTR_ERR(connector), 112 "Failed to init bridge connector\n"); 113 } 114 115 return 0; 116 } 117 118 static void dw_dp_rockchip_unbind(struct device *dev, struct device *master, 119 void *data) 120 { 121 struct rockchip_dw_dp *dp = dev_get_drvdata(dev); 122 123 dw_dp_unbind(dp->base); 124 } 125 126 static const struct component_ops dw_dp_rockchip_component_ops = { 127 .bind = dw_dp_rockchip_bind, 128 .unbind = dw_dp_rockchip_unbind, 129 }; 130 131 static int dw_dp_probe(struct platform_device *pdev) 132 { 133 return component_add(&pdev->dev, &dw_dp_rockchip_component_ops); 134 } 135 136 static void dw_dp_remove(struct platform_device *pdev) 137 { 138 component_del(&pdev->dev, &dw_dp_rockchip_component_ops); 139 } 140 141 static const struct dw_dp_plat_data rk3588_dp_plat_data = { 142 .max_link_rate = 810000, 143 .pixel_mode = DW_DP_MP_QUAD_PIXEL, 144 }; 145 146 static const struct dw_dp_plat_data rk3576_dp_plat_data = { 147 .max_link_rate = 810000, 148 .pixel_mode = DW_DP_MP_DUAL_PIXEL, 149 }; 150 151 static const struct of_device_id dw_dp_of_match[] = { 152 { 153 .compatible = "rockchip,rk3588-dp", 154 .data = &rk3588_dp_plat_data, 155 }, { 156 .compatible = "rockchip,rk3576-dp", 157 .data = &rk3576_dp_plat_data, 158 }, 159 {} 160 }; 161 MODULE_DEVICE_TABLE(of, dw_dp_of_match); 162 163 struct platform_driver dw_dp_driver = { 164 .probe = dw_dp_probe, 165 .remove = dw_dp_remove, 166 .driver = { 167 .name = "dw-dp", 168 .of_match_table = dw_dp_of_match, 169 }, 170 }; 171