drivers/gpu/drm/sun4i/sun4i_crtc.c

   1 /*
   2  * Copyright (C) 2015 Free Electrons
   3  * Copyright (C) 2015 NextThing Co
   4  *
   5  * Maxime Ripard <maxime.ripard@free-electrons.com>
   6  *
   7  * This program is free software; you can redistribute it and/or
   8  * modify it under the terms of the GNU General Public License as
   9  * published by the Free Software Foundation; either version 2 of
  10  * the License, or (at your option) any later version.
  11  */
  12
  13 #include <drm/drmP.h>
  14 #include <drm/drm_atomic_helper.h>
  15 #include <drm/drm_crtc.h>
  16 #include <drm/drm_crtc_helper.h>
  17 #include <drm/drm_modes.h>
  18
  19 #include <linux/clk-provider.h>
  20 #include <linux/ioport.h>
  21 #include <linux/of_address.h>
  22 #include <linux/of_graph.h>
  23 #include <linux/of_irq.h>
  24 #include <linux/regmap.h>
  25
  26 #include <video/videomode.h>
  27
  28 #include "sun4i_crtc.h"
  29 #include "sun4i_drv.h"
  30 #include "sunxi_engine.h"
  31 #include "sun4i_tcon.h"
  32
  33 /*
  34  * While this isn't really working in the DRM theory, in practice we
  35  * can only ever have one encoder per TCON since we have a mux in our
  36  * TCON.
  37  */
  38 static struct drm_encoder *sun4i_crtc_get_encoder(struct drm_crtc *crtc)
  39 {
  40         struct drm_encoder *encoder;
  41
  42         drm_for_each_encoder(encoder, crtc->dev)
  43                 if (encoder->crtc == crtc)
  44                         return encoder;
  45
  46         return NULL;
  47 }
  48
  49 static void sun4i_crtc_atomic_begin(struct drm_crtc *crtc,
  50                                     struct drm_crtc_state *old_state)
  51 {
  52         struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  53         struct drm_device *dev = crtc->dev;
  54         unsigned long flags;
  55
  56         if (crtc->state->event) {
  57                 WARN_ON(drm_crtc_vblank_get(crtc) != 0);
  58
  59                 spin_lock_irqsave(&dev->event_lock, flags);
  60                 scrtc->event = crtc->state->event;
  61                 spin_unlock_irqrestore(&dev->event_lock, flags);
  62                 crtc->state->event = NULL;
  63          }
  64 }
  65
  66 static void sun4i_crtc_atomic_flush(struct drm_crtc *crtc,
  67                                     struct drm_crtc_state *old_state)
  68 {
  69         struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  70         struct drm_pending_vblank_event *event = crtc->state->event;
  71
  72         DRM_DEBUG_DRIVER("Committing plane changes\n");
  73
  74         sunxi_engine_commit(scrtc->engine);
  75
  76         if (event) {
  77                 crtc->state->event = NULL;
  78
  79                 spin_lock_irq(&crtc->dev->event_lock);
  80                 if (drm_crtc_vblank_get(crtc) == 0)
  81                         drm_crtc_arm_vblank_event(crtc, event);
  82                 else
  83                         drm_crtc_send_vblank_event(crtc, event);
  84                 spin_unlock_irq(&crtc->dev->event_lock);
  85         }
  86 }
  87
  88 static void sun4i_crtc_atomic_disable(struct drm_crtc *crtc,
  89                                       struct drm_crtc_state *old_state)
  90 {
  91         struct drm_encoder *encoder = sun4i_crtc_get_encoder(crtc);
  92         struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  93
  94         DRM_DEBUG_DRIVER("Disabling the CRTC\n");
  95
  96         drm_crtc_vblank_off(crtc);
  97
  98         sun4i_tcon_set_status(scrtc->tcon, encoder, false);
  99
 100         if (crtc->state->event && !crtc->state->active) {
 101                 spin_lock_irq(&crtc->dev->event_lock);
 102                 drm_crtc_send_vblank_event(crtc, crtc->state->event);
 103                 spin_unlock_irq(&crtc->dev->event_lock);
 104
 105                 crtc->state->event = NULL;
 106         }
 107 }
 108
 109 static void sun4i_crtc_atomic_enable(struct drm_crtc *crtc,
 110                                      struct drm_crtc_state *old_state)
 111 {
 112         struct drm_encoder *encoder = sun4i_crtc_get_encoder(crtc);
 113         struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
 114
 115         DRM_DEBUG_DRIVER("Enabling the CRTC\n");
 116
 117         sun4i_tcon_set_status(scrtc->tcon, encoder, true);
 118
 119         drm_crtc_vblank_on(crtc);
 120 }
 121
 122 static void sun4i_crtc_mode_set_nofb(struct drm_crtc *crtc)
 123 {
 124         struct drm_display_mode *mode = &crtc->state->adjusted_mode;
 125         struct drm_encoder *encoder = sun4i_crtc_get_encoder(crtc);
 126         struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
 127
 128         sun4i_tcon_mode_set(scrtc->tcon, encoder, mode);
 129 }
 130
 131 static const struct drm_crtc_helper_funcs sun4i_crtc_helper_funcs = {
 132         .atomic_begin   = sun4i_crtc_atomic_begin,
 133         .atomic_flush   = sun4i_crtc_atomic_flush,
 134         .atomic_enable  = sun4i_crtc_atomic_enable,
 135         .atomic_disable = sun4i_crtc_atomic_disable,
 136         .mode_set_nofb  = sun4i_crtc_mode_set_nofb,
 137 };
 138
 139 static int sun4i_crtc_enable_vblank(struct drm_crtc *crtc)
 140 {
 141         struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
 142
 143         DRM_DEBUG_DRIVER("Enabling VBLANK on crtc %p\n", crtc);
 144
 145         sun4i_tcon_enable_vblank(scrtc->tcon, true);
 146
 147         return 0;
 148 }
 149
 150 static void sun4i_crtc_disable_vblank(struct drm_crtc *crtc)
 151 {
 152         struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
 153
 154         DRM_DEBUG_DRIVER("Disabling VBLANK on crtc %p\n", crtc);
 155
 156         sun4i_tcon_enable_vblank(scrtc->tcon, false);
 157 }
 158
 159 static const struct drm_crtc_funcs sun4i_crtc_funcs = {
 160         .atomic_destroy_state   = drm_atomic_helper_crtc_destroy_state,
 161         .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
 162         .destroy                = drm_crtc_cleanup,
 163         .page_flip              = drm_atomic_helper_page_flip,
 164         .reset                  = drm_atomic_helper_crtc_reset,
 165         .set_config             = drm_atomic_helper_set_config,
 166         .enable_vblank          = sun4i_crtc_enable_vblank,
 167         .disable_vblank         = sun4i_crtc_disable_vblank,
 168 };
 169
 170 struct sun4i_crtc *sun4i_crtc_init(struct drm_device *drm,
 171                                    struct sunxi_engine *engine,
 172                                    struct sun4i_tcon *tcon)
 173 {
 174         struct sun4i_crtc *scrtc;
 175         struct drm_plane **planes;
 176         struct drm_plane *primary = NULL, *cursor = NULL;
 177         int ret, i;
 178
 179         scrtc = devm_kzalloc(drm->dev, sizeof(*scrtc), GFP_KERNEL);
 180         if (!scrtc)
 181                 return ERR_PTR(-ENOMEM);
 182         scrtc->engine = engine;
 183         scrtc->tcon = tcon;
 184
 185         /* Create our layers */
 186         planes = sunxi_engine_layers_init(drm, engine);
 187         if (IS_ERR(planes)) {
 188                 dev_err(drm->dev, "Couldn't create the planes\n");
 189                 return NULL;
 190         }
 191
 192         /* find primary and cursor planes for drm_crtc_init_with_planes */
 193         for (i = 0; planes[i]; i++) {
 194                 struct drm_plane *plane = planes[i];
 195
 196                 switch (plane->type) {
 197                 case DRM_PLANE_TYPE_PRIMARY:
 198                         primary = plane;
 199                         break;
 200                 case DRM_PLANE_TYPE_CURSOR:
 201                         cursor = plane;
 202                         break;
 203                 default:
 204                         break;
 205                 }
 206         }
 207
 208         ret = drm_crtc_init_with_planes(drm, &scrtc->crtc,
 209                                         primary,
 210                                         cursor,
 211                                         &sun4i_crtc_funcs,
 212                                         NULL);
 213         if (ret) {
 214                 dev_err(drm->dev, "Couldn't init DRM CRTC\n");
 215                 return ERR_PTR(ret);
 216         }
 217
 218         drm_crtc_helper_add(&scrtc->crtc, &sun4i_crtc_helper_funcs);
 219
 220         /* Set crtc.port to output port node of the tcon */
 221         scrtc->crtc.port = of_graph_get_port_by_id(scrtc->tcon->dev->of_node,
 222                                                    1);
 223
 224         /* Set possible_crtcs to this crtc for overlay planes */
 225         for (i = 0; planes[i]; i++) {
 226                 uint32_t possible_crtcs = BIT(drm_crtc_index(&scrtc->crtc));
 227                 struct drm_plane *plane = planes[i];
 228
 229                 if (plane->type == DRM_PLANE_TYPE_OVERLAY)
 230                         plane->possible_crtcs = possible_crtcs;
 231         }
 232
 233         return scrtc;
 234 }