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
vkms_vblank_simulate(struct hrtimer * timer)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
vkms_enable_vblank(struct drm_crtc * crtc)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
vkms_disable_vblank(struct drm_crtc * crtc)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
vkms_get_vblank_timestamp(struct drm_device * dev,unsigned int pipe,int * max_error,ktime_t * vblank_time,bool in_vblank_irq)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
vkms_crtc_atomic_enable(struct drm_crtc * crtc,struct drm_crtc_state * old_state)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
vkms_crtc_atomic_disable(struct drm_crtc * crtc,struct drm_crtc_state * old_state)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
vkms_crtc_atomic_flush(struct drm_crtc * crtc,struct drm_crtc_state * old_crtc_state)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
vkms_crtc_init(struct drm_device * dev,struct drm_crtc * crtc,struct drm_plane * primary,struct drm_plane * cursor)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 }
128