drivers/gpu/drm/rockchip/analogix_dp-rockchip.c

   1 /*
   2  * Rockchip SoC DP (Display Port) interface driver.
   3  *
   4  * Copyright (C) Fuzhou Rockchip Electronics Co., Ltd.
   5  * Author: Andy Yan <andy.yan@rock-chips.com>
   6  *         Yakir Yang <ykk@rock-chips.com>
   7  *         Jeff Chen <jeff.chen@rock-chips.com>
   8  *
   9  * This program is free software; you can redistribute it and/or modify it
  10  * under the terms of the GNU General Public License as published by the
  11  * Free Software Foundation; either version 2 of the License, or (at your
  12  * option) any later version.
  13  */
  14
  15 #include <linux/component.h>
  16 #include <linux/mfd/syscon.h>
  17 #include <linux/of_device.h>
  18 #include <linux/of_graph.h>
  19 #include <linux/regmap.h>
  20 #include <linux/reset.h>
  21 #include <linux/clk.h>
  22
  23 #include <drm/drmP.h>
  24 #include <drm/drm_crtc_helper.h>
  25 #include <drm/drm_dp_helper.h>
  26 #include <drm/drm_of.h>
  27 #include <drm/drm_panel.h>
  28
  29 #include <video/of_videomode.h>
  30 #include <video/videomode.h>
  31
  32 #include <drm/bridge/analogix_dp.h>
  33
  34 #include "rockchip_drm_drv.h"
  35 #include "rockchip_drm_vop.h"
  36
  37 #define to_dp(nm)       container_of(nm, struct rockchip_dp_device, nm)
  38
  39 enum rockchip_dp_chip_type {
  40         RK3288_DP,
  41         RK3399_EDP,
  42 };
  43
  44 struct rockchip_dp_chip_data {
  45         u32     lcdsel_grf_reg;
  46         u32     lcdsel_big;
  47         u32     lcdsel_lit;
  48         u32     lcdsel_mask;
  49         u32     chip_type;
  50 };
  51
  52 struct rockchip_dp_device {
  53         struct drm_device        *drm_dev;
  54         struct device            *dev;
  55         struct drm_encoder       encoder;
  56         struct drm_display_mode  mode;
  57
  58         struct clk               *pclk;
  59         struct regmap            *grf;
  60         struct reset_control     *rst;
  61
  62         const struct rockchip_dp_chip_data *data;
  63
  64         struct analogix_dp_plat_data plat_data;
  65 };
  66
  67 static int rockchip_dp_pre_init(struct rockchip_dp_device *dp)
  68 {
  69         reset_control_assert(dp->rst);
  70         usleep_range(10, 20);
  71         reset_control_deassert(dp->rst);
  72
  73         return 0;
  74 }
  75
  76 static int rockchip_dp_poweron(struct analogix_dp_plat_data *plat_data)
  77 {
  78         struct rockchip_dp_device *dp = to_dp(plat_data);
  79         int ret;
  80
  81         ret = clk_prepare_enable(dp->pclk);
  82         if (ret < 0) {
  83                 dev_err(dp->dev, "failed to enable pclk %d\n", ret);
  84                 return ret;
  85         }
  86
  87         ret = rockchip_dp_pre_init(dp);
  88         if (ret < 0) {
  89                 dev_err(dp->dev, "failed to dp pre init %d\n", ret);
  90                 return ret;
  91         }
  92
  93         return 0;
  94 }
  95
  96 static int rockchip_dp_powerdown(struct analogix_dp_plat_data *plat_data)
  97 {
  98         struct rockchip_dp_device *dp = to_dp(plat_data);
  99
 100         clk_disable_unprepare(dp->pclk);
 101
 102         return 0;
 103 }
 104
 105 static enum drm_mode_status
 106 rockchip_dp_mode_valid(struct analogix_dp_plat_data *plat_data,
 107                        struct drm_connector *connector,
 108                        struct drm_display_mode *mode)
 109 {
 110         struct drm_display_info *di = &connector->display_info;
 111
 112         if (di->color_formats & DRM_COLOR_FORMAT_YCRCB444 ||
 113             di->color_formats & DRM_COLOR_FORMAT_YCRCB422) {
 114                 di->color_formats &= ~(DRM_COLOR_FORMAT_YCRCB422 |
 115                                        DRM_COLOR_FORMAT_YCRCB444);
 116                 di->color_formats |= DRM_COLOR_FORMAT_RGB444;
 117                 di->bpc = 8;
 118         }
 119
 120         return MODE_OK;
 121 }
 122
 123 static bool
 124 rockchip_dp_drm_encoder_mode_fixup(struct drm_encoder *encoder,
 125                                    const struct drm_display_mode *mode,
 126                                    struct drm_display_mode *adjusted_mode)
 127 {
 128         return true;
 129 }
 130
 131 static void rockchip_dp_drm_encoder_mode_set(struct drm_encoder *encoder,
 132                                              struct drm_display_mode *mode,
 133                                              struct drm_display_mode *adjusted)
 134 {
 135         /* do nothing */
 136 }
 137
 138 static void rockchip_dp_drm_encoder_enable(struct drm_encoder *encoder)
 139 {
 140         struct rockchip_dp_device *dp = to_dp(encoder);
 141         int ret;
 142         u32 val;
 143
 144         ret = rockchip_drm_encoder_get_mux_id(dp->dev->of_node, encoder);
 145         if (ret < 0)
 146                 return;
 147
 148         if (ret)
 149                 val = dp->data->lcdsel_lit | dp->data->lcdsel_mask;
 150         else
 151                 val = dp->data->lcdsel_big | dp->data->lcdsel_mask;
 152
 153         dev_dbg(dp->dev, "vop %s output to dp\n", (ret) ? "LIT" : "BIG");
 154
 155         ret = regmap_write(dp->grf, dp->data->lcdsel_grf_reg, val);
 156         if (ret != 0) {
 157                 dev_err(dp->dev, "Could not write to GRF: %d\n", ret);
 158                 return;
 159         }
 160 }
 161
 162 static void rockchip_dp_drm_encoder_nop(struct drm_encoder *encoder)
 163 {
 164         /* do nothing */
 165 }
 166
 167 static int
 168 rockchip_dp_drm_encoder_atomic_check(struct drm_encoder *encoder,
 169                                      struct drm_crtc_state *crtc_state,
 170                                      struct drm_connector_state *conn_state)
 171 {
 172         struct rockchip_dp_device *dp = to_dp(encoder);
 173         struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state);
 174         int ret;
 175
 176         /*
 177          * The hardware IC designed that VOP must output the RGB10 video
 178          * format to eDP contoller, and if eDP panel only support RGB8,
 179          * then eDP contoller should cut down the video data, not via VOP
 180          * contoller, that's why we need to hardcode the VOP output mode
 181          * to RGA10 here.
 182          */
 183
 184         ret = rockchip_drm_encoder_get_mux_id(dp->dev->of_node, encoder);
 185         if (ret < 0)
 186                 return true;
 187
 188         switch (dp->data->chip_type) {
 189         case RK3399_EDP:
 190                 /*
 191                  * For RK3399, VOP Lit must code the out mode to RGB888,
 192                  * VOP Big must code the out mode to RGB10.
 193                  */
 194                 if (ret)
 195                         s->output_mode = ROCKCHIP_OUT_MODE_P888;
 196                 else
 197                         s->output_mode = ROCKCHIP_OUT_MODE_AAAA;
 198                 break;
 199
 200         default:
 201                 s->output_mode = ROCKCHIP_OUT_MODE_AAAA;
 202                 break;
 203         }
 204         s->output_type = DRM_MODE_CONNECTOR_eDP;
 205
 206         return 0;
 207 }
 208
 209 static struct drm_encoder_helper_funcs rockchip_dp_encoder_helper_funcs = {
 210         .mode_fixup = rockchip_dp_drm_encoder_mode_fixup,
 211         .mode_set = rockchip_dp_drm_encoder_mode_set,
 212         .enable = rockchip_dp_drm_encoder_enable,
 213         .disable = rockchip_dp_drm_encoder_nop,
 214         .atomic_check = rockchip_dp_drm_encoder_atomic_check,
 215 };
 216
 217 static void rockchip_dp_drm_encoder_destroy(struct drm_encoder *encoder)
 218 {
 219         drm_encoder_cleanup(encoder);
 220 }
 221
 222 static struct drm_encoder_funcs rockchip_dp_encoder_funcs = {
 223         .destroy = rockchip_dp_drm_encoder_destroy,
 224 };
 225
 226 static int rockchip_dp_init(struct rockchip_dp_device *dp)
 227 {
 228         struct device *dev = dp->dev;
 229         struct device_node *np = dev->of_node;
 230         int ret;
 231
 232         dp->grf = syscon_regmap_lookup_by_phandle(np, "rockchip,grf");
 233         if (IS_ERR(dp->grf)) {
 234                 dev_err(dev, "failed to get rockchip,grf property\n");
 235                 return PTR_ERR(dp->grf);
 236         }
 237
 238         dp->pclk = devm_clk_get(dev, "pclk");
 239         if (IS_ERR(dp->pclk)) {
 240                 dev_err(dev, "failed to get pclk property\n");
 241                 return PTR_ERR(dp->pclk);
 242         }
 243
 244         dp->rst = devm_reset_control_get(dev, "dp");
 245         if (IS_ERR(dp->rst)) {
 246                 dev_err(dev, "failed to get dp reset control\n");
 247                 return PTR_ERR(dp->rst);
 248         }
 249
 250         ret = clk_prepare_enable(dp->pclk);
 251         if (ret < 0) {
 252                 dev_err(dp->dev, "failed to enable pclk %d\n", ret);
 253                 return ret;
 254         }
 255
 256         ret = rockchip_dp_pre_init(dp);
 257         if (ret < 0) {
 258                 dev_err(dp->dev, "failed to pre init %d\n", ret);
 259                 return ret;
 260         }
 261
 262         return 0;
 263 }
 264
 265 static int rockchip_dp_drm_create_encoder(struct rockchip_dp_device *dp)
 266 {
 267         struct drm_encoder *encoder = &dp->encoder;
 268         struct drm_device *drm_dev = dp->drm_dev;
 269         struct device *dev = dp->dev;
 270         int ret;
 271
 272         encoder->possible_crtcs = drm_of_find_possible_crtcs(drm_dev,
 273                                                              dev->of_node);
 274         DRM_DEBUG_KMS("possible_crtcs = 0x%x\n", encoder->possible_crtcs);
 275
 276         ret = drm_encoder_init(drm_dev, encoder, &rockchip_dp_encoder_funcs,
 277                                DRM_MODE_ENCODER_TMDS, NULL);
 278         if (ret) {
 279                 DRM_ERROR("failed to initialize encoder with drm\n");
 280                 return ret;
 281         }
 282
 283         drm_encoder_helper_add(encoder, &rockchip_dp_encoder_helper_funcs);
 284
 285         return 0;
 286 }
 287
 288 static int rockchip_dp_bind(struct device *dev, struct device *master,
 289                             void *data)
 290 {
 291         struct rockchip_dp_device *dp = dev_get_drvdata(dev);
 292         const struct rockchip_dp_chip_data *dp_data;
 293         struct drm_device *drm_dev = data;
 294         int ret;
 295
 296         /*
 297          * Just like the probe function said, we don't need the
 298          * device drvrate anymore, we should leave the charge to
 299          * analogix dp driver, set the device drvdata to NULL.
 300          */
 301         dev_set_drvdata(dev, NULL);
 302
 303         dp_data = of_device_get_match_data(dev);
 304         if (!dp_data)
 305                 return -ENODEV;
 306
 307         ret = rockchip_dp_init(dp);
 308         if (ret < 0)
 309                 return ret;
 310
 311         dp->data = dp_data;
 312         dp->drm_dev = drm_dev;
 313
 314         ret = rockchip_dp_drm_create_encoder(dp);
 315         if (ret) {
 316                 DRM_ERROR("failed to create drm encoder\n");
 317                 return ret;
 318         }
 319
 320         dp->plat_data.encoder = &dp->encoder;
 321
 322         dp->plat_data.dev_type = ROCKCHIP_DP;
 323         dp->plat_data.power_on = rockchip_dp_poweron;
 324         dp->plat_data.power_off = rockchip_dp_powerdown;
 325         dp->plat_data.mode_valid = rockchip_dp_mode_valid;
 326
 327         return analogix_dp_bind(dev, dp->drm_dev, &dp->plat_data);
 328 }
 329
 330 static void rockchip_dp_unbind(struct device *dev, struct device *master,
 331                                void *data)
 332 {
 333         return analogix_dp_unbind(dev, master, data);
 334 }
 335
 336 static const struct component_ops rockchip_dp_component_ops = {
 337         .bind = rockchip_dp_bind,
 338         .unbind = rockchip_dp_unbind,
 339 };
 340
 341 static int rockchip_dp_probe(struct platform_device *pdev)
 342 {
 343         struct device *dev = &pdev->dev;
 344         struct device_node *panel_node, *port, *endpoint;
 345         struct drm_panel *panel = NULL;
 346         struct rockchip_dp_device *dp;
 347
 348         port = of_graph_get_port_by_id(dev->of_node, 1);
 349         if (port) {
 350                 endpoint = of_get_child_by_name(port, "endpoint");
 351                 of_node_put(port);
 352                 if (!endpoint) {
 353                         dev_err(dev, "no output endpoint found\n");
 354                         return -EINVAL;
 355                 }
 356
 357                 panel_node = of_graph_get_remote_port_parent(endpoint);
 358                 of_node_put(endpoint);
 359                 if (!panel_node) {
 360                         dev_err(dev, "no output node found\n");
 361                         return -EINVAL;
 362                 }
 363
 364                 panel = of_drm_find_panel(panel_node);
 365                 if (!panel) {
 366                         DRM_ERROR("failed to find panel\n");
 367                         of_node_put(panel_node);
 368                         return -EPROBE_DEFER;
 369                 }
 370                 of_node_put(panel_node);
 371         }
 372
 373         dp = devm_kzalloc(dev, sizeof(*dp), GFP_KERNEL);
 374         if (!dp)
 375                 return -ENOMEM;
 376
 377         dp->dev = dev;
 378
 379         dp->plat_data.panel = panel;
 380
 381         /*
 382          * We just use the drvdata until driver run into component
 383          * add function, and then we would set drvdata to null, so
 384          * that analogix dp driver could take charge of the drvdata.
 385          */
 386         platform_set_drvdata(pdev, dp);
 387
 388         return component_add(dev, &rockchip_dp_component_ops);
 389 }
 390
 391 static int rockchip_dp_remove(struct platform_device *pdev)
 392 {
 393         component_del(&pdev->dev, &rockchip_dp_component_ops);
 394
 395         return 0;
 396 }
 397
 398 #ifdef CONFIG_PM_SLEEP
 399 static int rockchip_dp_suspend(struct device *dev)
 400 {
 401         return analogix_dp_suspend(dev);
 402 }
 403
 404 static int rockchip_dp_resume(struct device *dev)
 405 {
 406         return analogix_dp_resume(dev);
 407 }
 408 #endif
 409
 410 static const struct dev_pm_ops rockchip_dp_pm_ops = {
 411         SET_SYSTEM_SLEEP_PM_OPS(rockchip_dp_suspend, rockchip_dp_resume)
 412 };
 413
 414 static const struct rockchip_dp_chip_data rk3399_edp = {
 415         .lcdsel_grf_reg = 0x6250,
 416         .lcdsel_big = 0,
 417         .lcdsel_lit = BIT(5),
 418         .lcdsel_mask = BIT(21),
 419         .chip_type = RK3399_EDP,
 420 };
 421
 422 static const struct rockchip_dp_chip_data rk3288_dp = {
 423         .lcdsel_grf_reg = 0x025c,
 424         .lcdsel_big = 0,
 425         .lcdsel_lit = BIT(5),
 426         .lcdsel_mask = BIT(21),
 427         .chip_type = RK3288_DP,
 428 };
 429
 430 static const struct of_device_id rockchip_dp_dt_ids[] = {
 431         {.compatible = "rockchip,rk3288-dp", .data = &rk3288_dp },
 432         {.compatible = "rockchip,rk3399-edp", .data = &rk3399_edp },
 433         {}
 434 };
 435 MODULE_DEVICE_TABLE(of, rockchip_dp_dt_ids);
 436
 437 static struct platform_driver rockchip_dp_driver = {
 438         .probe = rockchip_dp_probe,
 439         .remove = rockchip_dp_remove,
 440         .driver = {
 441                    .name = "rockchip-dp",
 442                    .owner = THIS_MODULE,
 443                    .pm = &rockchip_dp_pm_ops,
 444                    .of_match_table = of_match_ptr(rockchip_dp_dt_ids),
 445         },
 446 };
 447
 448 module_platform_driver(rockchip_dp_driver);
 449
 450 MODULE_AUTHOR("Yakir Yang <ykk@rock-chips.com>");
 451 MODULE_AUTHOR("Jeff chen <jeff.chen@rock-chips.com>");
 452 MODULE_DESCRIPTION("Rockchip Specific Analogix-DP Driver Extension");
 453 MODULE_LICENSE("GPL v2");