kernel/drivers/gpu/drm/msm/mdp/mdp5/mdp5_cmd_encoder.c

   1 /*
   2  * Copyright (c) 2015, The Linux Foundation. All rights reserved.
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2 and
   6  * only version 2 as published by the Free Software Foundation.
   7  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11  * GNU General Public License for more details.
  12  */
  13
  14 #include "mdp5_kms.h"
  15
  16 #include "drm_crtc.h"
  17 #include "drm_crtc_helper.h"
  18
  19 struct mdp5_cmd_encoder {
  20         struct drm_encoder base;
  21         struct mdp5_interface intf;
  22         bool enabled;
  23         uint32_t bsc;
  24 };
  25 #define to_mdp5_cmd_encoder(x) container_of(x, struct mdp5_cmd_encoder, base)
  26
  27 static struct mdp5_kms *get_kms(struct drm_encoder *encoder)
  28 {
  29         struct msm_drm_private *priv = encoder->dev->dev_private;
  30         return to_mdp5_kms(to_mdp_kms(priv->kms));
  31 }
  32
  33 #ifdef CONFIG_MSM_BUS_SCALING
  34 #include <mach/board.h>
  35 #include <linux/msm-bus.h>
  36 #include <linux/msm-bus-board.h>
  37 #define MDP_BUS_VECTOR_ENTRY(ab_val, ib_val)            \
  38         {                                               \
  39                 .src = MSM_BUS_MASTER_MDP_PORT0,        \
  40                 .dst = MSM_BUS_SLAVE_EBI_CH0,           \
  41                 .ab = (ab_val),                         \
  42                 .ib = (ib_val),                         \
  43         }
  44
  45 static struct msm_bus_vectors mdp_bus_vectors[] = {
  46         MDP_BUS_VECTOR_ENTRY(0, 0),
  47         MDP_BUS_VECTOR_ENTRY(2000000000, 2000000000),
  48 };
  49 static struct msm_bus_paths mdp_bus_usecases[] = { {
  50                 .num_paths = 1,
  51                 .vectors = &mdp_bus_vectors[0],
  52 }, {
  53                 .num_paths = 1,
  54                 .vectors = &mdp_bus_vectors[1],
  55 } };
  56 static struct msm_bus_scale_pdata mdp_bus_scale_table = {
  57         .usecase = mdp_bus_usecases,
  58         .num_usecases = ARRAY_SIZE(mdp_bus_usecases),
  59         .name = "mdss_mdp",
  60 };
  61
  62 static void bs_init(struct mdp5_cmd_encoder *mdp5_cmd_enc)
  63 {
  64         mdp5_cmd_enc->bsc = msm_bus_scale_register_client(
  65                         &mdp_bus_scale_table);
  66         DBG("bus scale client: %08x", mdp5_cmd_enc->bsc);
  67 }
  68
  69 static void bs_fini(struct mdp5_cmd_encoder *mdp5_cmd_enc)
  70 {
  71         if (mdp5_cmd_enc->bsc) {
  72                 msm_bus_scale_unregister_client(mdp5_cmd_enc->bsc);
  73                 mdp5_cmd_enc->bsc = 0;
  74         }
  75 }
  76
  77 static void bs_set(struct mdp5_cmd_encoder *mdp5_cmd_enc, int idx)
  78 {
  79         if (mdp5_cmd_enc->bsc) {
  80                 DBG("set bus scaling: %d", idx);
  81                 /* HACK: scaling down, and then immediately back up
  82                  * seems to leave things broken (underflow).. so
  83                  * never disable:
  84                  */
  85                 idx = 1;
  86                 msm_bus_scale_client_update_request(mdp5_cmd_enc->bsc, idx);
  87         }
  88 }
  89 #else
  90 static void bs_init(struct mdp5_cmd_encoder *mdp5_cmd_enc) {}
  91 static void bs_fini(struct mdp5_cmd_encoder *mdp5_cmd_enc) {}
  92 static void bs_set(struct mdp5_cmd_encoder *mdp5_cmd_enc, int idx) {}
  93 #endif
  94
  95 #define VSYNC_CLK_RATE 19200000
  96 static int pingpong_tearcheck_setup(struct drm_encoder *encoder,
  97                                         struct drm_display_mode *mode)
  98 {
  99         struct mdp5_kms *mdp5_kms = get_kms(encoder);
 100         struct device *dev = encoder->dev->dev;
 101         u32 total_lines_x100, vclks_line, cfg;
 102         long vsync_clk_speed;
 103         int pp_id = GET_PING_PONG_ID(mdp5_crtc_get_lm(encoder->crtc));
 104
 105         if (IS_ERR_OR_NULL(mdp5_kms->vsync_clk)) {
 106                 dev_err(dev, "vsync_clk is not initialized\n");
 107                 return -EINVAL;
 108         }
 109
 110         total_lines_x100 = mode->vtotal * mode->vrefresh;
 111         if (!total_lines_x100) {
 112                 dev_err(dev, "%s: vtotal(%d) or vrefresh(%d) is 0\n",
 113                                 __func__, mode->vtotal, mode->vrefresh);
 114                 return -EINVAL;
 115         }
 116
 117         vsync_clk_speed = clk_round_rate(mdp5_kms->vsync_clk, VSYNC_CLK_RATE);
 118         if (vsync_clk_speed <= 0) {
 119                 dev_err(dev, "vsync_clk round rate failed %ld\n",
 120                                                         vsync_clk_speed);
 121                 return -EINVAL;
 122         }
 123         vclks_line = vsync_clk_speed * 100 / total_lines_x100;
 124
 125         cfg = MDP5_PP_SYNC_CONFIG_VSYNC_COUNTER_EN
 126                 | MDP5_PP_SYNC_CONFIG_VSYNC_IN_EN;
 127         cfg |= MDP5_PP_SYNC_CONFIG_VSYNC_COUNT(vclks_line);
 128
 129         mdp5_write(mdp5_kms, REG_MDP5_PP_SYNC_CONFIG_VSYNC(pp_id), cfg);
 130         mdp5_write(mdp5_kms,
 131                 REG_MDP5_PP_SYNC_CONFIG_HEIGHT(pp_id), 0xfff0);
 132         mdp5_write(mdp5_kms,
 133                 REG_MDP5_PP_VSYNC_INIT_VAL(pp_id), mode->vdisplay);
 134         mdp5_write(mdp5_kms, REG_MDP5_PP_RD_PTR_IRQ(pp_id), mode->vdisplay + 1);
 135         mdp5_write(mdp5_kms, REG_MDP5_PP_START_POS(pp_id), mode->vdisplay);
 136         mdp5_write(mdp5_kms, REG_MDP5_PP_SYNC_THRESH(pp_id),
 137                         MDP5_PP_SYNC_THRESH_START(4) |
 138                         MDP5_PP_SYNC_THRESH_CONTINUE(4));
 139
 140         return 0;
 141 }
 142
 143 static int pingpong_tearcheck_enable(struct drm_encoder *encoder)
 144 {
 145         struct mdp5_kms *mdp5_kms = get_kms(encoder);
 146         int pp_id = GET_PING_PONG_ID(mdp5_crtc_get_lm(encoder->crtc));
 147         int ret;
 148
 149         ret = clk_set_rate(mdp5_kms->vsync_clk,
 150                 clk_round_rate(mdp5_kms->vsync_clk, VSYNC_CLK_RATE));
 151         if (ret) {
 152                 dev_err(encoder->dev->dev,
 153                         "vsync_clk clk_set_rate failed, %d\n", ret);
 154                 return ret;
 155         }
 156         ret = clk_prepare_enable(mdp5_kms->vsync_clk);
 157         if (ret) {
 158                 dev_err(encoder->dev->dev,
 159                         "vsync_clk clk_prepare_enable failed, %d\n", ret);
 160                 return ret;
 161         }
 162
 163         mdp5_write(mdp5_kms, REG_MDP5_PP_TEAR_CHECK_EN(pp_id), 1);
 164
 165         return 0;
 166 }
 167
 168 static void pingpong_tearcheck_disable(struct drm_encoder *encoder)
 169 {
 170         struct mdp5_kms *mdp5_kms = get_kms(encoder);
 171         int pp_id = GET_PING_PONG_ID(mdp5_crtc_get_lm(encoder->crtc));
 172
 173         mdp5_write(mdp5_kms, REG_MDP5_PP_TEAR_CHECK_EN(pp_id), 0);
 174         clk_disable_unprepare(mdp5_kms->vsync_clk);
 175 }
 176
 177 static void mdp5_cmd_encoder_destroy(struct drm_encoder *encoder)
 178 {
 179         struct mdp5_cmd_encoder *mdp5_cmd_enc = to_mdp5_cmd_encoder(encoder);
 180         bs_fini(mdp5_cmd_enc);
 181         drm_encoder_cleanup(encoder);
 182         kfree(mdp5_cmd_enc);
 183 }
 184
 185 static const struct drm_encoder_funcs mdp5_cmd_encoder_funcs = {
 186         .destroy = mdp5_cmd_encoder_destroy,
 187 };
 188
 189 static bool mdp5_cmd_encoder_mode_fixup(struct drm_encoder *encoder,
 190                 const struct drm_display_mode *mode,
 191                 struct drm_display_mode *adjusted_mode)
 192 {
 193         return true;
 194 }
 195
 196 static void mdp5_cmd_encoder_mode_set(struct drm_encoder *encoder,
 197                 struct drm_display_mode *mode,
 198                 struct drm_display_mode *adjusted_mode)
 199 {
 200         struct mdp5_cmd_encoder *mdp5_cmd_enc = to_mdp5_cmd_encoder(encoder);
 201
 202         mode = adjusted_mode;
 203
 204         DBG("set mode: %d:\"%s\" %d %d %d %d %d %d %d %d %d %d 0x%x 0x%x",
 205                         mode->base.id, mode->name,
 206                         mode->vrefresh, mode->clock,
 207                         mode->hdisplay, mode->hsync_start,
 208                         mode->hsync_end, mode->htotal,
 209                         mode->vdisplay, mode->vsync_start,
 210                         mode->vsync_end, mode->vtotal,
 211                         mode->type, mode->flags);
 212         pingpong_tearcheck_setup(encoder, mode);
 213         mdp5_crtc_set_intf(encoder->crtc, &mdp5_cmd_enc->intf);
 214 }
 215
 216 static void mdp5_cmd_encoder_disable(struct drm_encoder *encoder)
 217 {
 218         struct mdp5_cmd_encoder *mdp5_cmd_enc = to_mdp5_cmd_encoder(encoder);
 219         struct mdp5_kms *mdp5_kms = get_kms(encoder);
 220         struct mdp5_ctl *ctl = mdp5_crtc_get_ctl(encoder->crtc);
 221         struct mdp5_interface *intf = &mdp5_cmd_enc->intf;
 222         int lm = mdp5_crtc_get_lm(encoder->crtc);
 223
 224         if (WARN_ON(!mdp5_cmd_enc->enabled))
 225                 return;
 226
 227         /* Wait for the last frame done */
 228         mdp_irq_wait(&mdp5_kms->base, lm2ppdone(lm));
 229         pingpong_tearcheck_disable(encoder);
 230
 231         mdp5_ctl_set_encoder_state(ctl, false);
 232         mdp5_ctl_commit(ctl, mdp_ctl_flush_mask_encoder(intf));
 233
 234         bs_set(mdp5_cmd_enc, 0);
 235
 236         mdp5_cmd_enc->enabled = false;
 237 }
 238
 239 static void mdp5_cmd_encoder_enable(struct drm_encoder *encoder)
 240 {
 241         struct mdp5_cmd_encoder *mdp5_cmd_enc = to_mdp5_cmd_encoder(encoder);
 242         struct mdp5_ctl *ctl = mdp5_crtc_get_ctl(encoder->crtc);
 243         struct mdp5_interface *intf = &mdp5_cmd_enc->intf;
 244
 245         if (WARN_ON(mdp5_cmd_enc->enabled))
 246                 return;
 247
 248         bs_set(mdp5_cmd_enc, 1);
 249         if (pingpong_tearcheck_enable(encoder))
 250                 return;
 251
 252         mdp5_ctl_commit(ctl, mdp_ctl_flush_mask_encoder(intf));
 253
 254         mdp5_ctl_set_encoder_state(ctl, true);
 255
 256         mdp5_cmd_enc->enabled = true;
 257 }
 258
 259 static const struct drm_encoder_helper_funcs mdp5_cmd_encoder_helper_funcs = {
 260         .mode_fixup = mdp5_cmd_encoder_mode_fixup,
 261         .mode_set = mdp5_cmd_encoder_mode_set,
 262         .disable = mdp5_cmd_encoder_disable,
 263         .enable = mdp5_cmd_encoder_enable,
 264 };
 265
 266 int mdp5_cmd_encoder_set_split_display(struct drm_encoder *encoder,
 267                                         struct drm_encoder *slave_encoder)
 268 {
 269         struct mdp5_cmd_encoder *mdp5_cmd_enc = to_mdp5_cmd_encoder(encoder);
 270         struct mdp5_kms *mdp5_kms;
 271         int intf_num;
 272         u32 data = 0;
 273
 274         if (!encoder || !slave_encoder)
 275                 return -EINVAL;
 276
 277         mdp5_kms = get_kms(encoder);
 278         intf_num = mdp5_cmd_enc->intf.num;
 279
 280         /* Switch slave encoder's trigger MUX, to use the master's
 281          * start signal for the slave encoder
 282          */
 283         if (intf_num == 1)
 284                 data |= MDP5_SPLIT_DPL_UPPER_INTF2_SW_TRG_MUX;
 285         else if (intf_num == 2)
 286                 data |= MDP5_SPLIT_DPL_UPPER_INTF1_SW_TRG_MUX;
 287         else
 288                 return -EINVAL;
 289
 290         /* Smart Panel, Sync mode */
 291         data |= MDP5_SPLIT_DPL_UPPER_SMART_PANEL;
 292
 293         /* Make sure clocks are on when connectors calling this function. */
 294         mdp5_enable(mdp5_kms);
 295         mdp5_write(mdp5_kms, REG_MDP5_SPLIT_DPL_UPPER, data);
 296
 297         mdp5_write(mdp5_kms, REG_MDP5_SPLIT_DPL_LOWER,
 298                         MDP5_SPLIT_DPL_LOWER_SMART_PANEL);
 299         mdp5_write(mdp5_kms, REG_MDP5_SPLIT_DPL_EN, 1);
 300         mdp5_disable(mdp5_kms);
 301
 302         return 0;
 303 }
 304
 305 /* initialize command mode encoder */
 306 struct drm_encoder *mdp5_cmd_encoder_init(struct drm_device *dev,
 307                                 struct mdp5_interface *intf)
 308 {
 309         struct drm_encoder *encoder = NULL;
 310         struct mdp5_cmd_encoder *mdp5_cmd_enc;
 311         int ret;
 312
 313         if (WARN_ON((intf->type != INTF_DSI) &&
 314                 (intf->mode != MDP5_INTF_DSI_MODE_COMMAND))) {
 315                 ret = -EINVAL;
 316                 goto fail;
 317         }
 318
 319         mdp5_cmd_enc = kzalloc(sizeof(*mdp5_cmd_enc), GFP_KERNEL);
 320         if (!mdp5_cmd_enc) {
 321                 ret = -ENOMEM;
 322                 goto fail;
 323         }
 324
 325         memcpy(&mdp5_cmd_enc->intf, intf, sizeof(mdp5_cmd_enc->intf));
 326         encoder = &mdp5_cmd_enc->base;
 327
 328         drm_encoder_init(dev, encoder, &mdp5_cmd_encoder_funcs,
 329                         DRM_MODE_ENCODER_DSI);
 330
 331         drm_encoder_helper_add(encoder, &mdp5_cmd_encoder_helper_funcs);
 332
 333         bs_init(mdp5_cmd_enc);
 334
 335         return encoder;
 336
 337 fail:
 338         if (encoder)
 339                 mdp5_cmd_encoder_destroy(encoder);
 340
 341         return ERR_PTR(ret);
 342 }
 343