drivers/staging/omapdrm/omap_crtc.c

   1 /*
   2  * drivers/staging/omapdrm/omap_crtc.c
   3  *
   4  * Copyright (C) 2011 Texas Instruments
   5  * Author: Rob Clark <rob@ti.com>
   6  *
   7  * This program is free software; you can redistribute it and/or modify it
   8  * under the terms of the GNU General Public License version 2 as published by
   9  * the Free Software Foundation.
  10  *
  11  * This program is distributed in the hope that it will be useful, but WITHOUT
  12  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  14  * more details.
  15  *
  16  * You should have received a copy of the GNU General Public License along with
  17  * this program.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include "omap_drv.h"
  21
  22 #include "drm_mode.h"
  23 #include "drm_crtc.h"
  24 #include "drm_crtc_helper.h"
  25
  26 #define to_omap_crtc(x) container_of(x, struct omap_crtc, base)
  27
  28 struct omap_crtc {
  29         struct drm_crtc base;
  30         struct drm_plane *plane;
  31         const char *name;
  32         int id;
  33
  34         /* if there is a pending flip, these will be non-null: */
  35         struct drm_pending_vblank_event *event;
  36         struct drm_framebuffer *old_fb;
  37 };
  38
  39 static void omap_crtc_destroy(struct drm_crtc *crtc)
  40 {
  41         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
  42         omap_crtc->plane->funcs->destroy(omap_crtc->plane);
  43         drm_crtc_cleanup(crtc);
  44         kfree(omap_crtc);
  45 }
  46
  47 static void omap_crtc_dpms(struct drm_crtc *crtc, int mode)
  48 {
  49         struct omap_drm_private *priv = crtc->dev->dev_private;
  50         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
  51         int i;
  52
  53         WARN_ON(omap_plane_dpms(omap_crtc->plane, mode));
  54
  55         for (i = 0; i < priv->num_planes; i++) {
  56                 struct drm_plane *plane = priv->planes[i];
  57                 if (plane->crtc == crtc)
  58                         WARN_ON(omap_plane_dpms(plane, mode));
  59         }
  60 }
  61
  62 static bool omap_crtc_mode_fixup(struct drm_crtc *crtc,
  63                 const struct drm_display_mode *mode,
  64                 struct drm_display_mode *adjusted_mode)
  65 {
  66         return true;
  67 }
  68
  69 static int omap_crtc_mode_set(struct drm_crtc *crtc,
  70                 struct drm_display_mode *mode,
  71                 struct drm_display_mode *adjusted_mode,
  72                 int x, int y,
  73                 struct drm_framebuffer *old_fb)
  74 {
  75         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
  76         struct drm_plane *plane = omap_crtc->plane;
  77
  78         return omap_plane_mode_set(plane, crtc, crtc->fb,
  79                         0, 0, mode->hdisplay, mode->vdisplay,
  80                         x << 16, y << 16,
  81                         mode->hdisplay << 16, mode->vdisplay << 16);
  82 }
  83
  84 static void omap_crtc_prepare(struct drm_crtc *crtc)
  85 {
  86         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
  87         DBG("%s", omap_crtc->name);
  88         omap_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
  89 }
  90
  91 static void omap_crtc_commit(struct drm_crtc *crtc)
  92 {
  93         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
  94         DBG("%s", omap_crtc->name);
  95         omap_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
  96 }
  97
  98 static int omap_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y,
  99                 struct drm_framebuffer *old_fb)
 100 {
 101         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
 102         struct drm_plane *plane = omap_crtc->plane;
 103         struct drm_display_mode *mode = &crtc->mode;
 104
 105         return plane->funcs->update_plane(plane, crtc, crtc->fb,
 106                         0, 0, mode->hdisplay, mode->vdisplay,
 107                         x << 16, y << 16,
 108                         mode->hdisplay << 16, mode->vdisplay << 16);
 109 }
 110
 111 static void omap_crtc_load_lut(struct drm_crtc *crtc)
 112 {
 113 }
 114
 115 static void vblank_cb(void *arg)
 116 {
 117         static uint32_t sequence = 0;
 118         struct drm_crtc *crtc = arg;
 119         struct drm_device *dev = crtc->dev;
 120         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
 121         struct drm_pending_vblank_event *event = omap_crtc->event;
 122         unsigned long flags;
 123         struct timeval now;
 124
 125         WARN_ON(!event);
 126
 127         omap_crtc->event = NULL;
 128
 129         /* wakeup userspace */
 130         if (event) {
 131                 do_gettimeofday(&now);
 132
 133                 spin_lock_irqsave(&dev->event_lock, flags);
 134                 /* TODO: we can't yet use the vblank time accounting,
 135                  * because omapdss lower layer is the one that knows
 136                  * the irq # and registers the handler, which more or
 137                  * less defeats how drm_irq works.. for now just fake
 138                  * the sequence number and use gettimeofday..
 139                  *
 140                 event->event.sequence = drm_vblank_count_and_time(
 141                                 dev, omap_crtc->id, &now);
 142                  */
 143                 event->event.sequence = sequence++;
 144                 event->event.tv_sec = now.tv_sec;
 145                 event->event.tv_usec = now.tv_usec;
 146                 list_add_tail(&event->base.link,
 147                                 &event->base.file_priv->event_list);
 148                 wake_up_interruptible(&event->base.file_priv->event_wait);
 149                 spin_unlock_irqrestore(&dev->event_lock, flags);
 150         }
 151 }
 152
 153 static void page_flip_cb(void *arg)
 154 {
 155         struct drm_crtc *crtc = arg;
 156         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
 157         struct drm_framebuffer *old_fb = omap_crtc->old_fb;
 158         struct drm_gem_object *bo;
 159
 160         omap_crtc->old_fb = NULL;
 161
 162         omap_crtc_mode_set_base(crtc, crtc->x, crtc->y, old_fb);
 163
 164         /* really we'd like to setup the callback atomically w/ setting the
 165          * new scanout buffer to avoid getting stuck waiting an extra vblank
 166          * cycle.. for now go for correctness and later figure out speed..
 167          */
 168         omap_plane_on_endwin(omap_crtc->plane, vblank_cb, crtc);
 169
 170         bo = omap_framebuffer_bo(crtc->fb, 0);
 171         drm_gem_object_unreference_unlocked(bo);
 172 }
 173
 174 static int omap_crtc_page_flip_locked(struct drm_crtc *crtc,
 175                  struct drm_framebuffer *fb,
 176                  struct drm_pending_vblank_event *event)
 177 {
 178         struct drm_device *dev = crtc->dev;
 179         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
 180         struct drm_gem_object *bo;
 181
 182         DBG("%d -> %d", crtc->fb ? crtc->fb->base.id : -1, fb->base.id);
 183
 184         if (omap_crtc->event) {
 185                 dev_err(dev->dev, "already a pending flip\n");
 186                 return -EINVAL;
 187         }
 188
 189         omap_crtc->old_fb = crtc->fb;
 190         omap_crtc->event = event;
 191         crtc->fb = fb;
 192
 193         /*
 194          * Hold a reference temporarily until the crtc is updated
 195          * and takes the reference to the bo.  This avoids it
 196          * getting freed from under us:
 197          */
 198         bo = omap_framebuffer_bo(fb, 0);
 199         drm_gem_object_reference(bo);
 200
 201         omap_gem_op_async(bo, OMAP_GEM_READ, page_flip_cb, crtc);
 202
 203         return 0;
 204 }
 205
 206 static int omap_crtc_set_property(struct drm_crtc *crtc,
 207                 struct drm_property *property, uint64_t val)
 208 {
 209         struct omap_crtc *omap_crtc = to_omap_crtc(crtc);
 210         struct omap_drm_private *priv = crtc->dev->dev_private;
 211
 212         if (property == priv->rotation_prop) {
 213                 crtc->invert_dimensions =
 214                                 !!(val & ((1LL << DRM_ROTATE_90) | (1LL << DRM_ROTATE_270)));
 215         }
 216
 217         return omap_plane_set_property(omap_crtc->plane, property, val);
 218 }
 219
 220 static const struct drm_crtc_funcs omap_crtc_funcs = {
 221         .set_config = drm_crtc_helper_set_config,
 222         .destroy = omap_crtc_destroy,
 223         .page_flip = omap_crtc_page_flip_locked,
 224         .set_property = omap_crtc_set_property,
 225 };
 226
 227 static const struct drm_crtc_helper_funcs omap_crtc_helper_funcs = {
 228         .dpms = omap_crtc_dpms,
 229         .mode_fixup = omap_crtc_mode_fixup,
 230         .mode_set = omap_crtc_mode_set,
 231         .prepare = omap_crtc_prepare,
 232         .commit = omap_crtc_commit,
 233         .mode_set_base = omap_crtc_mode_set_base,
 234         .load_lut = omap_crtc_load_lut,
 235 };
 236
 237 /* initialize crtc */
 238 struct drm_crtc *omap_crtc_init(struct drm_device *dev,
 239                 struct omap_overlay *ovl, int id)
 240 {
 241         struct drm_crtc *crtc = NULL;
 242         struct omap_crtc *omap_crtc = kzalloc(sizeof(*omap_crtc), GFP_KERNEL);
 243
 244         DBG("%s", ovl->name);
 245
 246         if (!omap_crtc) {
 247                 dev_err(dev->dev, "could not allocate CRTC\n");
 248                 goto fail;
 249         }
 250
 251         crtc = &omap_crtc->base;
 252
 253         omap_crtc->plane = omap_plane_init(dev, ovl, (1 << id), true);
 254         omap_crtc->plane->crtc = crtc;
 255         omap_crtc->name = ovl->name;
 256         omap_crtc->id = id;
 257
 258         drm_crtc_init(dev, crtc, &omap_crtc_funcs);
 259         drm_crtc_helper_add(crtc, &omap_crtc_helper_funcs);
 260
 261         omap_plane_install_properties(omap_crtc->plane, &crtc->base);
 262
 263         return crtc;
 264
 265 fail:
 266         if (crtc) {
 267                 omap_crtc_destroy(crtc);
 268         }
 269         return NULL;
 270 }