drivers/gpu/drm/vkms/vkms_crtc.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2
   3 #include "vkms_drv.h"
   4 #include <drm/drm_atomic_helper.h>
   5 #include <drm/drm_crtc_helper.h>
   6
   7 static enum hrtimer_restart vkms_vblank_simulate(struct hrtimer *timer)
   8 {
   9         struct vkms_output *output = container_of(timer, struct vkms_output,
  10                                                   vblank_hrtimer);
  11         struct drm_crtc *crtc = &output->crtc;
  12         int ret_overrun;
  13         bool ret;
  14
  15         ret = drm_crtc_handle_vblank(crtc);
  16         if (!ret)
  17                 DRM_ERROR("vkms failure on handling vblank");
  18
  19         ret_overrun = hrtimer_forward_now(&output->vblank_hrtimer,
  20                                           output->period_ns);
  21
  22         return HRTIMER_RESTART;
  23 }
  24
  25 static int vkms_enable_vblank(struct drm_crtc *crtc)
  26 {
  27         struct drm_device *dev = crtc->dev;
  28         unsigned int pipe = drm_crtc_index(crtc);
  29         struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
  30         struct vkms_output *out = drm_crtc_to_vkms_output(crtc);
  31
  32         drm_calc_timestamping_constants(crtc, &crtc->mode);
  33
  34         hrtimer_init(&out->vblank_hrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
  35         out->vblank_hrtimer.function = &vkms_vblank_simulate;
  36         out->period_ns = ktime_set(0, vblank->framedur_ns);
  37         hrtimer_start(&out->vblank_hrtimer, out->period_ns, HRTIMER_MODE_REL);
  38
  39         return 0;
  40 }
  41
  42 static void vkms_disable_vblank(struct drm_crtc *crtc)
  43 {
  44         struct vkms_output *out = drm_crtc_to_vkms_output(crtc);
  45
  46         hrtimer_cancel(&out->vblank_hrtimer);
  47 }
  48
  49 bool vkms_get_vblank_timestamp(struct drm_device *dev, unsigned int pipe,
  50                                int *max_error, ktime_t *vblank_time,
  51                                bool in_vblank_irq)
  52 {
  53         struct vkms_device *vkmsdev = drm_device_to_vkms_device(dev);
  54         struct vkms_output *output = &vkmsdev->output;
  55
  56         *vblank_time = output->vblank_hrtimer.node.expires;
  57
  58         if (!in_vblank_irq)
  59                 *vblank_time -= output->period_ns;
  60
  61         return true;
  62 }
  63
  64 static const struct drm_crtc_funcs vkms_crtc_funcs = {
  65         .set_config             = drm_atomic_helper_set_config,
  66         .destroy                = drm_crtc_cleanup,
  67         .page_flip              = drm_atomic_helper_page_flip,
  68         .reset                  = drm_atomic_helper_crtc_reset,
  69         .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
  70         .atomic_destroy_state   = drm_atomic_helper_crtc_destroy_state,
  71         .enable_vblank          = vkms_enable_vblank,
  72         .disable_vblank         = vkms_disable_vblank,
  73 };
  74
  75 static void vkms_crtc_atomic_enable(struct drm_crtc *crtc,
  76                                     struct drm_crtc_state *old_state)
  77 {
  78         drm_crtc_vblank_on(crtc);
  79 }
  80
  81 static void vkms_crtc_atomic_disable(struct drm_crtc *crtc,
  82                                      struct drm_crtc_state *old_state)
  83 {
  84         drm_crtc_vblank_off(crtc);
  85 }
  86
  87 static void vkms_crtc_atomic_flush(struct drm_crtc *crtc,
  88                                    struct drm_crtc_state *old_crtc_state)
  89 {
  90         unsigned long flags;
  91
  92         if (crtc->state->event) {
  93                 spin_lock_irqsave(&crtc->dev->event_lock, flags);
  94
  95                 if (drm_crtc_vblank_get(crtc) != 0)
  96                         drm_crtc_send_vblank_event(crtc, crtc->state->event);
  97                 else
  98                         drm_crtc_arm_vblank_event(crtc, crtc->state->event);
  99
 100                 spin_unlock_irqrestore(&crtc->dev->event_lock, flags);
 101
 102                 crtc->state->event = NULL;
 103         }
 104 }
 105
 106 static const struct drm_crtc_helper_funcs vkms_crtc_helper_funcs = {
 107         .atomic_flush   = vkms_crtc_atomic_flush,
 108         .atomic_enable  = vkms_crtc_atomic_enable,
 109         .atomic_disable = vkms_crtc_atomic_disable,
 110 };
 111
 112 int vkms_crtc_init(struct drm_device *dev, struct drm_crtc *crtc,
 113                    struct drm_plane *primary, struct drm_plane *cursor)
 114 {
 115         int ret;
 116
 117         ret = drm_crtc_init_with_planes(dev, crtc, primary, cursor,
 118                                         &vkms_crtc_funcs, NULL);
 119         if (ret) {
 120                 DRM_ERROR("Failed to init CRTC\n");
 121                 return ret;
 122         }
 123
 124         drm_crtc_helper_add(crtc, &vkms_crtc_helper_funcs);
 125
 126         return ret;
 127 }