1 /**************************************************************************
5 * Copyright 2015 Samsung Electronics co., Ltd. All Rights Reserved.
7 * Contact: Eunchul Kim <chulspro.kim@samsung.com>,
8 * JinYoung Jeon <jy0.jeon@samsung.com>,
9 * Taeheon Kim <th908.kim@samsung.com>,
10 * YoungJun Cho <yj44.cho@samsung.com>,
11 * SooChan Lim <sc1.lim@samsung.com>,
12 * Boram Park <sc1.lim@samsung.com>
14 * Permission is hereby granted, free of charge, to any person obtaining a
15 * copy of this software and associated documentation files (the
16 * "Software"), to deal in the Software without restriction, including
17 * without limitation the rights to use, copy, modify, merge, publish,
18 * distribute, sub license, and/or sell copies of the Software, and to
19 * permit persons to whom the Software is furnished to do so, subject to
20 * the following conditions:
22 * The above copyright notice and this permission notice (including the
23 * next paragraph) shall be included in all copies or substantial portions
26 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
27 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
28 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
29 * IN NO EVENT SHALL PRECISION INSIGHT AND/OR ITS SUPPLIERS BE LIABLE FOR
30 * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
31 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
32 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
34 **************************************************************************/
41 #include "tdm_private.h"
45 * Basically tdm vblank doesn't care about thread things.
46 * However, to use tdm_event_loop_xxx functions, have to use the internal function.
47 * So need to lock/unlock the mutex of private_display. And valid_vblank_list and
48 * valid_wait_list should be protected by valid_list_lock because tdm_vblank can
49 * be used in multi-thread.
53 * - aligned by HW vblank
54 * - use a tdm_event_loop_source object only.
57 /* We expact "(unsigned int)(0.0016667 / 0.0016667) = 1". But it becomes 0. */
58 #define TDM_TIME_MARGIN 0.0000001
60 #define TDM_VBLANK_UINT_MAX 4294967295U
61 #define TDM_VBLANK_UINT_1Q 1073741823U /* UINT_MAX / 4 */
62 #define TDM_VBLANK_UINT_3Q 3221225471U /* UINT_MAX / 4 * 3 */
64 /* (seq < TDM_VBLANK_UINT_1Q && TDM_VBLANK_UINT_3Q < last_seq) means
65 * that the sequence value has reached the max value and started from 0 again.
67 #define TDM_VBLANK_SEQ_REACHED_MAX(seq, last_seq) \
68 ((seq) < TDM_VBLANK_UINT_1Q && TDM_VBLANK_UINT_3Q < (last_seq))
70 #define VER(fmt, arg...) TDM_ERR("[%p] "fmt, private_vblank, ##arg)
71 #define VWR(fmt, arg...) TDM_WRN("[%p] "fmt, private_vblank, ##arg)
72 #define VIN(fmt, arg...) TDM_INFO("[%p] "fmt, private_vblank, ##arg)
73 #define VDB(fmt, arg...) TDM_DBG("[%p] "fmt, private_vblank, ##arg)
80 } tdm_vblank_wait_type;
82 typedef struct _tdm_vblank_wait_info tdm_vblank_wait_info;
84 typedef struct _tdm_private_vblank {
85 struct list_head valid_link;
93 unsigned int vrefresh;
95 unsigned int check_HW_or_SW;
96 char name[TDM_NAME_LEN];
99 unsigned int enable_fake;
100 unsigned int ignore_global_fps;
103 unsigned int quotient;
105 unsigned int last_seq;
108 unsigned int add_front;
109 struct wl_resource *resource;
112 double HW_vblank_gap;
113 struct list_head HW_wait_list;
116 tdm_event_loop_source *SW_timer;
117 struct list_head SW_wait_list;
118 } tdm_private_vblank;
120 struct _tdm_vblank_wait_info {
121 struct list_head link;
122 struct list_head valid_link;
127 unsigned int interval;
129 tdm_vblank_handler func;
131 tdm_private_vblank *private_vblank;
133 tdm_vblank_wait_type type;
136 unsigned int target_seq;
139 /* valid_vblank_list and valid_wait_list should be protected by valid_list_lock because
140 * tdm_vblank can be used in multi-thread.
142 static pthread_mutex_t valid_list_lock;
143 static struct list_head valid_vblank_list;
144 static struct list_head valid_wait_list;
145 static unsigned int vblank_list_inited;
146 static unsigned int vblank_global_fps;
147 static double stamp = 0;
149 static tdm_error _tdm_vblank_cb_vblank_SW(void *user_data);
150 static tdm_error _tdm_vblank_wait_SW(tdm_vblank_wait_info *wait_info);
151 static void _tdm_vblank_cb_vblank_HW(tdm_output *output, unsigned int sequence,
152 unsigned int tv_sec, unsigned int tv_usec,
157 _print_list(struct list_head *list)
159 tdm_vblank_wait_info *w = NULL;
161 LIST_FOR_EACH_ENTRY(w, list, link) {
162 printf(" %d", w->interval);
169 _tdm_vblank_valid_list_add(struct list_head *valid_link, struct list_head *valid_list)
171 pthread_mutex_lock(&valid_list_lock);
172 LIST_ADDTAIL(valid_link, valid_list);
173 pthread_mutex_unlock(&valid_list_lock);
177 _tdm_vblank_valid_list_del(struct list_head *valid_link)
179 pthread_mutex_lock(&valid_list_lock);
180 LIST_DEL(valid_link);
181 pthread_mutex_unlock(&valid_list_lock);
184 static inline tdm_private_vblank*
185 _tdm_vblank_find(double vblank_stamp)
187 tdm_private_vblank *v = NULL;
192 pthread_mutex_lock(&valid_list_lock);
193 LIST_FOR_EACH_ENTRY(v, &valid_vblank_list, valid_link) {
194 if (v->stamp == vblank_stamp) {
195 pthread_mutex_unlock(&valid_list_lock);
199 pthread_mutex_unlock(&valid_list_lock);
204 static inline unsigned int
205 _tdm_vblank_check_valid_wait(tdm_vblank_wait_info *wait_info)
207 tdm_vblank_wait_info *w = NULL;
212 pthread_mutex_lock(&valid_list_lock);
213 LIST_FOR_EACH_ENTRY(w, &valid_wait_list, valid_link) {
214 if (w == wait_info) {
215 pthread_mutex_unlock(&valid_list_lock);
219 pthread_mutex_unlock(&valid_list_lock);
224 static inline unsigned int
225 _tdm_vblank_find_wait(tdm_vblank_wait_info *wait_info, struct list_head *list)
227 tdm_vblank_wait_info *w = NULL;
232 LIST_FOR_EACH_ENTRY(w, list, link) {
233 if (w->stamp == wait_info->stamp)
241 _tdm_vblank_insert_wait(tdm_vblank_wait_info *wait_info, struct list_head *list)
243 tdm_vblank_wait_info *w = NULL;
244 tdm_vblank_wait_info *found = NULL;
246 if (LIST_IS_EMPTY(list)) {
247 LIST_ADDTAIL(&wait_info->link, list);
251 LIST_FOR_EACH_ENTRY(w, list, link) {
252 if (wait_info->type == VBLANK_TYPE_SW) {
253 if (wait_info->target_time == 0)
254 TDM_NEVER_GET_HERE();
255 if (w->target_time <= wait_info->target_time) {
260 if (w->interval <= wait_info->interval) {
268 LIST_ADD(&wait_info->link, &found->link);
270 LIST_ADDTAIL(&wait_info->link, list->next);
274 _tdm_vblank_change_to_SW(tdm_private_vblank *private_vblank)
276 tdm_vblank_wait_info *w = NULL, *ww = NULL;
278 LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->HW_wait_list, link) {
280 tdm_output_remove_vblank_handler_internal(private_vblank->output, _tdm_vblank_cb_vblank_HW, w);
281 w->type = VBLANK_TYPE_SW_FAKE;
282 _tdm_vblank_wait_SW(w);
287 _tdm_vblank_free_HW_wait(tdm_private_vblank *private_vblank, tdm_error error, unsigned int call_cb)
289 tdm_vblank_wait_info *w = NULL, *ww = NULL;
291 LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->HW_wait_list, link) {
293 _tdm_vblank_valid_list_del(&w->valid_link);
294 tdm_output_remove_vblank_handler_internal(private_vblank->output, _tdm_vblank_cb_vblank_HW, w);
296 if (call_cb && w->func)
297 w->func(private_vblank, error, 0, 0, 0, w->user_data);
304 _tdm_vblank_cb_output_change(tdm_output *output, tdm_output_change_type type,
305 tdm_value value, void *user_data)
307 tdm_private_vblank *private_vblank = user_data;
309 TDM_RETURN_IF_FAIL(private_vblank != NULL);
312 case TDM_OUTPUT_CHANGE_DPMS:
313 if (private_vblank->dpms == value.u32)
315 VDB("dpms %s", tdm_dpms_str(value.u32));
316 private_vblank->dpms = value.u32;
317 private_vblank->check_HW_or_SW = 1;
318 if (private_vblank->dpms != TDM_OUTPUT_DPMS_ON) {
319 if (private_vblank->enable_fake)
320 _tdm_vblank_change_to_SW(private_vblank);
322 _tdm_vblank_free_HW_wait(private_vblank, TDM_ERROR_DPMS_OFF, 1);
325 case TDM_OUTPUT_CHANGE_CONNECTION:
326 VDB("output %s", tdm_status_str(value.u32));
327 if (value.u32 == TDM_OUTPUT_CONN_STATUS_DISCONNECTED)
328 _tdm_vblank_free_HW_wait(private_vblank, 0, 0);
336 tdm_vblank_set_client_vblank_fps(unsigned int pid, const char *name, unsigned int fps)
338 tdm_private_vblank *v = NULL;
340 TDM_RETURN_VAL_IF_FAIL(pid > 0, TDM_ERROR_INVALID_PARAMETER);
341 TDM_RETURN_VAL_IF_FAIL(fps > 0, TDM_ERROR_INVALID_PARAMETER);
343 TDM_INFO("pid: %u, name: %s, fps: %d", pid, name, fps);
345 pthread_mutex_lock(&valid_list_lock);
346 LIST_FOR_EACH_ENTRY(v, &valid_vblank_list, valid_link) {
347 struct wl_client *client;
348 pid_t client_pid = 0;
353 client = wl_resource_get_client(v->resource);
357 wl_client_get_credentials(client, &client_pid, NULL, NULL);
359 if (client_pid != pid)
362 if (name && strncmp(name, TDM_VBLANK_DEFAULT_NAME, TDM_NAME_LEN)) {
363 if (strncmp(v->name, name, TDM_NAME_LEN))
367 tdm_vblank_set_fps(v, fps);
369 TDM_INFO("(pid:%u) '%s' fps changed: %d", pid, v->name, fps);
371 pthread_mutex_unlock(&valid_list_lock);
373 return TDM_ERROR_NONE;
377 tdm_vblank_enable_global_fps(unsigned int enable, unsigned int fps)
379 tdm_private_vblank *v = NULL;
382 TDM_RETURN_VAL_IF_FAIL(fps > 0, TDM_ERROR_INVALID_PARAMETER);
384 TDM_INFO("global fps: %s fps(%d)", (enable) ? "enabled" : "disabled", fps);
386 pthread_mutex_lock(&valid_list_lock);
388 vblank_global_fps = (enable) ? fps : 0;
390 LIST_FOR_EACH_ENTRY(v, &valid_vblank_list, valid_link) {
391 /* skip if vblank is created in server side */
395 v->check_HW_or_SW = 1;
397 pthread_mutex_unlock(&valid_list_lock);
399 return TDM_ERROR_NONE;
403 tdm_vblank_create(tdm_display *dpy, tdm_output *output, tdm_error *error)
405 tdm_private_vblank *private_vblank;
406 const tdm_output_mode *mode = NULL;
407 tdm_output_dpms dpms = TDM_OUTPUT_DPMS_ON;
410 TDM_RETURN_VAL_IF_FAIL_WITH_ERROR(dpy != NULL, TDM_ERROR_INVALID_PARAMETER, NULL);
411 TDM_RETURN_VAL_IF_FAIL_WITH_ERROR(output != NULL, TDM_ERROR_INVALID_PARAMETER, NULL);
414 *error = TDM_ERROR_NONE;
416 if (!vblank_list_inited) {
417 if (pthread_mutex_init(&valid_list_lock, NULL)) {
418 TDM_ERR("mutex init failed: %m");
420 *error = TDM_ERROR_OPERATION_FAILED;
423 LIST_INITHEAD(&valid_vblank_list);
424 LIST_INITHEAD(&valid_wait_list);
425 vblank_list_inited = 1;
428 tdm_output_get_mode(output, &mode);
431 *error = TDM_ERROR_OPERATION_FAILED;
436 tdm_output_get_dpms(output, &dpms);
438 private_vblank = calloc(1, sizeof * private_vblank);
439 if (!private_vblank) {
441 *error = TDM_ERROR_OUT_OF_MEMORY;
446 tdm_output_add_change_handler(output, _tdm_vblank_cb_output_change, private_vblank);
448 private_vblank->stamp = ++stamp;
449 private_vblank->owner_tid = syscall(SYS_gettid);
450 private_vblank->dpy = dpy;
451 private_vblank->output = output;
452 private_vblank->dpms = dpms;
453 private_vblank->vrefresh = mode->vrefresh;
454 private_vblank->HW_vblank_gap = 1.0 / private_vblank->vrefresh;
456 private_vblank->check_HW_or_SW = 1;
457 private_vblank->fps = mode->vrefresh;
459 strncpy(private_vblank->name, TDM_VBLANK_DEFAULT_NAME, TDM_NAME_LEN - 1);
460 private_vblank->name[TDM_NAME_LEN - 1] = '\0';
462 LIST_INITHEAD(&private_vblank->HW_wait_list);
463 LIST_INITHEAD(&private_vblank->SW_wait_list);
465 _tdm_vblank_valid_list_add(&private_vblank->valid_link, &valid_vblank_list);
467 if (tdm_debug_module & TDM_DEBUG_VBLANK)
468 VIN("created. vrefresh(%d) dpms(%d)",
469 private_vblank->vrefresh, private_vblank->dpms);
471 return (tdm_vblank *)private_vblank;
475 tdm_vblank_destroy(tdm_vblank *vblank)
477 tdm_private_vblank *private_vblank = vblank;
478 tdm_vblank_wait_info *w = NULL, *ww = NULL;
483 _tdm_vblank_valid_list_del(&private_vblank->valid_link);
485 if (private_vblank->SW_timer) {
486 tdm_display_lock(private_vblank->dpy);
487 tdm_event_loop_source_remove(private_vblank->SW_timer);
488 tdm_display_unlock(private_vblank->dpy);
491 tdm_output_remove_change_handler(private_vblank->output,
492 _tdm_vblank_cb_output_change, private_vblank);
494 _tdm_vblank_free_HW_wait(private_vblank, 0, 0);
496 LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->SW_wait_list, link) {
498 _tdm_vblank_valid_list_del(&w->valid_link);
502 if (tdm_debug_module & TDM_DEBUG_VBLANK)
505 free(private_vblank);
509 tdm_vblank_set_name(tdm_vblank *vblank, const char *name)
511 tdm_private_vblank *private_vblank = vblank;
513 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
516 name = TDM_VBLANK_DEFAULT_NAME;
518 strncpy(private_vblank->name, name, TDM_NAME_LEN - 1);
519 private_vblank->name[TDM_NAME_LEN - 1] = '\0';
521 if (tdm_debug_module & TDM_DEBUG_VBLANK)
522 VIN("name(%s)", name);
524 return TDM_ERROR_NONE;
528 tdm_vblank_get_name(tdm_vblank *vblank, const char **name)
530 tdm_private_vblank *private_vblank = vblank;
532 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
533 TDM_RETURN_VAL_IF_FAIL(name != NULL, TDM_ERROR_INVALID_PARAMETER);
535 *name = (const char*)private_vblank->name;
537 return TDM_ERROR_NONE;
541 tdm_vblank_set_fps(tdm_vblank *vblank, unsigned int fps)
543 tdm_private_vblank *private_vblank = vblank;
545 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
546 TDM_RETURN_VAL_IF_FAIL(fps > 0, TDM_ERROR_INVALID_PARAMETER);
548 if (private_vblank->fps == fps)
549 return TDM_ERROR_NONE;
551 private_vblank->fps = fps;
552 private_vblank->check_HW_or_SW = 1;
554 if (tdm_debug_module & TDM_DEBUG_VBLANK)
555 VIN("fps(%d)", private_vblank->fps);
557 return TDM_ERROR_NONE;
561 tdm_vblank_get_fps(tdm_vblank *vblank, unsigned int *fps)
563 tdm_private_vblank *private_vblank = vblank;
565 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
566 TDM_RETURN_VAL_IF_FAIL(fps != NULL, TDM_ERROR_INVALID_PARAMETER);
568 *fps = private_vblank->fps;
570 return TDM_ERROR_NONE;
574 tdm_vblank_ignore_global_fps(tdm_vblank *vblank, unsigned int ignore)
576 tdm_private_vblank *private_vblank = vblank;
578 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
580 if (private_vblank->ignore_global_fps == ignore)
581 return TDM_ERROR_NONE;
583 private_vblank->ignore_global_fps = ignore;
584 private_vblank->check_HW_or_SW = 1;
586 if (tdm_debug_module & TDM_DEBUG_VBLANK)
587 VIN("ignore_global_fps(%d)", private_vblank->ignore_global_fps);
589 return TDM_ERROR_NONE;
593 tdm_vblank_set_offset(tdm_vblank *vblank, int offset)
595 tdm_private_vblank *private_vblank = vblank;
597 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
599 if (private_vblank->offset == offset)
600 return TDM_ERROR_NONE;
602 private_vblank->offset = offset;
603 private_vblank->check_HW_or_SW = 1;
605 if (tdm_debug_module & TDM_DEBUG_VBLANK)
606 VIN("offset(%d)", private_vblank->offset);
608 return TDM_ERROR_NONE;
612 tdm_vblank_get_offset(tdm_vblank *vblank, int *offset)
614 tdm_private_vblank *private_vblank = vblank;
616 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
617 TDM_RETURN_VAL_IF_FAIL(offset != NULL, TDM_ERROR_INVALID_PARAMETER);
619 *offset = private_vblank->offset;
621 return TDM_ERROR_NONE;
625 tdm_vblank_set_enable_fake(tdm_vblank *vblank, unsigned int enable_fake)
627 tdm_private_vblank *private_vblank = vblank;
629 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
631 if (private_vblank->enable_fake == enable_fake)
632 return TDM_ERROR_NONE;
634 private_vblank->enable_fake = enable_fake;
636 if (tdm_debug_module & TDM_DEBUG_VBLANK)
637 VIN("enable_fake(%d)", private_vblank->enable_fake);
639 return TDM_ERROR_NONE;
643 tdm_vblank_get_enable_fake(tdm_vblank *vblank, unsigned int *enable_fake)
645 tdm_private_vblank *private_vblank = vblank;
647 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
648 TDM_RETURN_VAL_IF_FAIL(enable_fake != NULL, TDM_ERROR_INVALID_PARAMETER);
650 *enable_fake = private_vblank->enable_fake;
652 return TDM_ERROR_NONE;
656 _tdm_vblank_sw_timer_update(tdm_private_vblank *private_vblank)
658 tdm_vblank_wait_info *first_wait_info = NULL;
663 if (LIST_IS_EMPTY(&private_vblank->SW_wait_list)) {
665 return TDM_ERROR_OPERATION_FAILED;
668 first_wait_info = container_of(private_vblank->SW_wait_list.next, first_wait_info, link);
669 curr = tdm_helper_get_time();
670 target = first_wait_info->target_time;
672 /* ms_delay should be more that 1 */
676 ms_delay = ceil((target - curr) * 1000.0);
682 VER("wait(%p) curr(%.6f) target(%.6f) ms_delay(%d)", first_wait_info, curr, target, ms_delay);
683 else if (tdm_debug_module & TDM_DEBUG_VBLANK)
684 VIN("wait(%p) curr(%.6f) target(%.6f) ms_delay(%d)", first_wait_info, curr, target, ms_delay);
686 tdm_display_lock(private_vblank->dpy);
688 if (!private_vblank->SW_timer) {
689 private_vblank->SW_timer =
690 tdm_event_loop_add_timer_handler(private_vblank->dpy,
691 _tdm_vblank_cb_vblank_SW,
694 if (!private_vblank->SW_timer) {
695 tdm_display_unlock(private_vblank->dpy);
696 VER("couldn't add timer");
699 VIN("Use SW vblank");
702 ret = tdm_event_loop_source_timer_update(private_vblank->SW_timer, ms_delay);
703 if (ret != TDM_ERROR_NONE) {
704 tdm_display_unlock(private_vblank->dpy);
705 VER("couldn't update timer");
709 tdm_display_unlock(private_vblank->dpy);
711 return TDM_ERROR_NONE;
715 _tdm_vblank_cb_vblank_HW(tdm_output *output, unsigned int sequence,
716 unsigned int tv_sec, unsigned int tv_usec,
719 tdm_vblank_wait_info *wait_info = user_data;
720 tdm_private_vblank *private_vblank;
722 if (!_tdm_vblank_check_valid_wait(wait_info)) {
723 TDM_DBG("can't find wait(%p) from valid_wait_list", wait_info);
727 private_vblank = wait_info->private_vblank;
728 TDM_RETURN_IF_FAIL(private_vblank != NULL);
730 if (!_tdm_vblank_find_wait(wait_info, &private_vblank->HW_wait_list)) {
731 VDB("can't find wait(%p)", wait_info);
735 if (wait_info->type == VBLANK_TYPE_HW_SW) {
738 LIST_DEL(&wait_info->link);
740 /* kernel sends the wrong time of first vblank event. and the time of
741 * second vblank is correct.
743 wait_info->target_time = TDM_TIME(tv_sec, tv_usec);
744 wait_info->target_time += (((double)private_vblank->offset) / 1000.0);
746 _tdm_vblank_insert_wait(wait_info, &private_vblank->SW_wait_list);
748 ret = _tdm_vblank_sw_timer_update(private_vblank);
750 /* wait_info will be freed in _tdm_vblank_cb_vblank_SW() */
751 if (ret == TDM_ERROR_NONE) {
752 if (tdm_debug_module & TDM_DEBUG_VBLANK)
753 VIN("wait(%p) SW timer", wait_info);
757 VWR("couldn't update sw timer");
760 /* tv_sec & tv_usec shouldn't be zero. But sometimes they are zero in some hardware.
761 * We need to prohibit that last_time becomes zero because "last_time == 0" means
762 * that a tdm_vblank object is just created and doesn't have the first vblank event.
763 * If last_time becomes 0, it would make issue.
765 if (tv_sec == 0 && tv_usec == 0) {
766 double curr = tdm_helper_get_time();
767 tv_sec = TDM_TIME_SEC(curr);
768 tv_usec = TDM_TIME_USEC(curr);
771 private_vblank->last_seq = wait_info->target_seq;
772 private_vblank->last_time = TDM_TIME(tv_sec, tv_usec);
774 if (tdm_debug_module & TDM_DEBUG_VBLANK)
775 VIN("wait(%p) last(%.6f) sequence(%u) done", wait_info, private_vblank->last_time, wait_info->target_seq);
778 wait_info->func(private_vblank, TDM_ERROR_NONE, wait_info->target_seq,
779 tv_sec, tv_usec, wait_info->user_data);
781 LIST_DEL(&wait_info->link);
782 _tdm_vblank_valid_list_del(&wait_info->valid_link);
787 _tdm_vblank_wait_HW(tdm_vblank_wait_info *wait_info)
789 tdm_private_vblank *private_vblank = wait_info->private_vblank;
793 _tdm_vblank_insert_wait(wait_info, &private_vblank->HW_wait_list);
795 hw_interval = wait_info->interval * private_vblank->quotient;
797 if (private_vblank->last_time == 0) {
798 /* SW vblank starts from now. SW vblank doesn't need to be aligned with HW vblank. */
799 private_vblank->last_seq = 0;
800 private_vblank->last_time = tdm_helper_get_time();
802 /* +1 ms to call the handler ASAP at the first. no matter for SW timer. */
803 wait_info->target_seq = 1;
804 if (tdm_debug_module & TDM_DEBUG_VBLANK)
805 VIN("wait(%p) last(%.6f) hw_itvl(%d) targ_seq(%u)",
806 wait_info, private_vblank->last_time, hw_interval, wait_info->target_seq);
808 double last, prev, req, curr, target;
811 last = private_vblank->last_time;
812 req = wait_info->req_time;
814 skip = (unsigned int)((req - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
815 prev = last + private_vblank->vblank_gap * skip;
817 curr = tdm_helper_get_time();
819 while (target < curr)
820 target += (private_vblank->vblank_gap * wait_info->interval);
822 hw_interval = (unsigned int)((target - curr) / private_vblank->HW_vblank_gap + TDM_TIME_MARGIN) + 1;
824 wait_info->target_seq = private_vblank->last_seq;
825 wait_info->target_seq += (unsigned int)((target - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
827 if (hw_interval > 300)
828 VER("wait(%p) last(%.6f) req(%.6f) prev(%.6f) curr(%.6f) targ(%.6f,%.6f) skip(%u) hw_itvl(%d) targ_seq(%u)",
829 wait_info, last, req - last, prev - last, curr - last, target, target - last,
830 skip, hw_interval, wait_info->target_seq);
831 else if (tdm_debug_module & TDM_DEBUG_VBLANK)
832 VIN("wait(%p) last(%.6f) req(%.6f) prev(%.6f) curr(%.6f) targ(%.6f,%.6f) skip(%u) hw_itvl(%d) targ_seq(%u)",
833 wait_info, last, req - last, prev - last, curr - last, target, target - last,
834 skip, hw_interval, wait_info->target_seq);
837 if (private_vblank->add_front)
838 ret = tdm_output_wait_vblank_add_front(private_vblank->output, hw_interval, 0,
839 _tdm_vblank_cb_vblank_HW, wait_info);
841 ret = tdm_output_wait_vblank(private_vblank->output, hw_interval, 0,
842 _tdm_vblank_cb_vblank_HW, wait_info);
844 if (ret != TDM_ERROR_NONE) {
845 LIST_DEL(&wait_info->link);
849 if (tdm_debug_module & TDM_DEBUG_VBLANK)
850 VIN("wait(%p) waiting", wait_info);
852 return TDM_ERROR_NONE;
856 _tdm_vblank_cb_vblank_SW(void *user_data)
858 tdm_private_vblank *private_vblank = user_data;
860 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_OPERATION_FAILED);
862 return tdm_vblank_cb_vblank_SW(private_vblank, 0);
866 tdm_vblank_cb_vblank_SW(tdm_vblank *vblank, double vblank_stamp)
868 tdm_private_vblank *private_vblank;
869 tdm_vblank_wait_info *first_wait_info = NULL, *w = NULL, *ww = NULL;
871 TDM_RETURN_VAL_IF_FAIL(vblank || vblank_stamp > 0, TDM_ERROR_INVALID_PARAMETER);
874 private_vblank = vblank;
876 private_vblank = _tdm_vblank_find(vblank_stamp);
877 if (!private_vblank) {
878 TDM_DBG("can't find vblank(%.0f) from valid_list", vblank_stamp);
879 return TDM_ERROR_NONE;
883 if (private_vblank->owner_tid != syscall(SYS_gettid)) {
884 tdm_thread_cb_vblank_sw vblank_sw;
885 tdm_private_display *private_display = private_vblank->dpy;
888 vblank_sw.base.type = TDM_THREAD_CB_VBLANK_SW;
889 vblank_sw.base.length = sizeof vblank_sw;
890 vblank_sw.vblank_stamp = private_vblank->stamp;
892 ret = tdm_thread_send_cb(private_display->private_loop, &vblank_sw.base);
893 TDM_WARNING_IF_FAIL(ret == TDM_ERROR_NONE);
895 return TDM_ERROR_NONE;
898 if (LIST_IS_EMPTY(&private_vblank->SW_wait_list)) {
900 return TDM_ERROR_OPERATION_FAILED;
903 first_wait_info = container_of(private_vblank->SW_wait_list.next, first_wait_info, link);
904 TDM_RETURN_VAL_IF_FAIL(first_wait_info != NULL, TDM_ERROR_OPERATION_FAILED);
906 if (private_vblank->last_seq >= first_wait_info->target_seq)
907 TDM_ERR("last_seq(%u) target_seq(%u)", private_vblank->last_seq, first_wait_info->target_seq);
909 private_vblank->last_seq = first_wait_info->target_seq;
910 private_vblank->last_time = first_wait_info->target_time;
912 if (tdm_debug_module & TDM_DEBUG_VBLANK)
913 VIN("wait(%p) last(%.6f) sequence(%u) done", first_wait_info, private_vblank->last_time, first_wait_info->target_seq);
915 LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->SW_wait_list, link) {
916 if (w->target_time != first_wait_info->target_time)
920 _tdm_vblank_valid_list_del(&w->valid_link);
923 tdm_display_unlock(private_vblank->dpy);
924 w->func(private_vblank, TDM_ERROR_NONE, w->target_seq,
925 TDM_TIME_SEC(w->target_time), TDM_TIME_USEC(w->target_time),
927 tdm_display_lock(private_vblank->dpy);
933 return TDM_ERROR_NONE;
937 _tdm_vblank_wait_SW(tdm_vblank_wait_info *wait_info)
939 tdm_private_vblank *private_vblank = wait_info->private_vblank;
942 if (private_vblank->last_time == 0) {
943 /* SW vblank starts from now. SW vblank doesn't need to be aligned with HW vblank. */
944 private_vblank->last_seq = 0;
945 private_vblank->last_time = tdm_helper_get_time();
947 /* +1 ms to call the handler ASAP at the first. no matter for SW timer. */
948 wait_info->target_seq = 1;
949 wait_info->target_time = private_vblank->last_time + 0.001;
951 if (tdm_debug_module & TDM_DEBUG_VBLANK)
952 VIN("wait(%p) last(%.6f) target(%.6f) target sequence(%u)",
953 wait_info, private_vblank->last_time, wait_info->target_time, wait_info->target_seq);
955 double last, prev, req, curr, target;
958 last = private_vblank->last_time;
959 req = wait_info->req_time;
961 skip = (unsigned int)((req - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
962 prev = last + private_vblank->vblank_gap * skip;
964 curr = tdm_helper_get_time();
965 target = prev + private_vblank->vblank_gap * wait_info->interval;
967 while (target < curr)
968 target += private_vblank->vblank_gap;
970 wait_info->target_seq = private_vblank->last_seq;
971 wait_info->target_seq += (unsigned int)((target - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
973 wait_info->target_time = target;
975 if (tdm_debug_module & TDM_DEBUG_VBLANK)
976 VIN("wait(%p) last(%.6f) req(%.6f) prev(%.6f) curr(%.6f) targ(%.6f,%.6f) skip(%u) targ_seq(%u)",
977 wait_info, last, req - last, prev - last, curr - last,
978 target, target - last, skip, wait_info->target_seq);
981 _tdm_vblank_insert_wait(wait_info, &private_vblank->SW_wait_list);
983 ret = _tdm_vblank_sw_timer_update(private_vblank);
984 if (ret != TDM_ERROR_NONE) {
985 LIST_DEL(&wait_info->link);
986 VER("couldn't update sw timer");
990 return TDM_ERROR_NONE;
994 tdm_vblank_wait(tdm_vblank *vblank, unsigned int req_sec, unsigned int req_usec,
995 unsigned int interval, tdm_vblank_handler func, void *user_data)
997 tdm_private_vblank *private_vblank = vblank;
998 tdm_vblank_wait_info *wait_info;
1002 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
1003 TDM_RETURN_VAL_IF_FAIL(func != NULL, TDM_ERROR_INVALID_PARAMETER);
1005 if (private_vblank->owner_tid != syscall(SYS_gettid)) {
1006 TDM_ERR("SHOULD be called in the owner thread(%d)", (int)private_vblank->owner_tid);
1007 return TDM_ERROR_BAD_REQUEST;
1010 if (private_vblank->dpms != TDM_OUTPUT_DPMS_ON && !private_vblank->enable_fake) {
1011 VIN("can't wait a vblank because of DPMS off");
1012 return TDM_ERROR_DPMS_OFF;
1015 wait_info = calloc(1, sizeof * wait_info);
1017 VER("alloc failed");
1018 return TDM_ERROR_OUT_OF_MEMORY;
1021 /* set request time to current time if 0. This function seems to be called in server side. */
1022 if (req_sec == 0 && req_usec == 0) {
1023 double curr = tdm_helper_get_time();
1024 req_sec = TDM_TIME_SEC(curr);
1025 req_usec = TDM_TIME_USEC(curr);
1028 LIST_INITHEAD(&wait_info->link);
1030 _tdm_vblank_valid_list_add(&wait_info->valid_link, &valid_wait_list);
1032 wait_info->stamp = ++stamp;
1033 wait_info->req_time = TDM_TIME(req_sec, req_usec);
1034 wait_info->interval = interval;
1035 wait_info->func = func;
1036 wait_info->user_data = user_data;
1037 wait_info->private_vblank = private_vblank;
1039 if (private_vblank->ignore_global_fps ||
1040 vblank_global_fps == 0 ||
1041 private_vblank->fps < vblank_global_fps)
1042 fps = private_vblank->fps;
1044 fps = vblank_global_fps;
1046 if (private_vblank->check_HW_or_SW) {
1047 private_vblank->check_HW_or_SW = 0;
1048 private_vblank->vblank_gap = 1.0 / fps;
1049 private_vblank->quotient = private_vblank->vrefresh / fps;
1052 /* 1) if fps != factor of vrefresh, SW timer
1053 * 2) if fps == factor of vrefresh && dpms == off, SW timer (Fake HW vblank)
1054 * 2) if fps == factor of vrefresh && dpms == on && offset == 0, HW vblank
1055 * 3) if fps == factor of vrefresh && dpms == on && offset != 0, HW vblank + SW timer
1056 * In case of 1), we really don't need to align with HW vblank.
1058 if (private_vblank->vrefresh % fps)
1059 wait_info->type = VBLANK_TYPE_SW;
1060 else if (private_vblank->dpms == TDM_OUTPUT_DPMS_OFF)
1061 wait_info->type = VBLANK_TYPE_SW_FAKE;
1062 else if (private_vblank->offset == 0)
1063 wait_info->type = VBLANK_TYPE_HW;
1065 wait_info->type = VBLANK_TYPE_HW_SW;
1067 if (wait_info->type == VBLANK_TYPE_SW || wait_info->type == VBLANK_TYPE_SW_FAKE)
1068 ret = _tdm_vblank_wait_SW(wait_info);
1070 ret = _tdm_vblank_wait_HW(wait_info);
1071 if (ret == TDM_ERROR_DPMS_OFF)
1072 ret = _tdm_vblank_wait_SW(wait_info);
1075 if (ret != TDM_ERROR_NONE) {
1076 LIST_DEL(&wait_info->link);
1077 _tdm_vblank_valid_list_del(&wait_info->valid_link);
1078 tdm_output_remove_vblank_handler_internal(private_vblank->output, _tdm_vblank_cb_vblank_HW, wait_info);
1083 return TDM_ERROR_NONE;
1087 tdm_vblank_wait_seq(tdm_vblank *vblank, unsigned int req_sec, unsigned int req_usec,
1088 unsigned int sequence, tdm_vblank_handler func, void *user_data)
1090 tdm_private_vblank *private_vblank = vblank;
1091 unsigned int interval;
1093 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
1094 TDM_RETURN_VAL_IF_FAIL(func != NULL, TDM_ERROR_INVALID_PARAMETER);
1096 /* if the sequence of vblank reaches the max value, sequence can be 0. */
1098 if (private_vblank->last_seq == 0) {
1099 TDM_WRN("can't calculate interval with sequence(%u)", sequence);
1101 } else if (sequence > private_vblank->last_seq ||
1102 TDM_VBLANK_SEQ_REACHED_MAX(sequence, private_vblank->last_seq)) {
1103 double last, curr, seq_target;
1105 last = private_vblank->last_time;
1106 curr = tdm_helper_get_time();
1107 seq_target = last + private_vblank->vblank_gap * (sequence - private_vblank->last_seq);
1109 /* If target is old or too close(1ms) to current, we call the handler immediately.
1110 * 2ms? it seems too much.
1112 if (seq_target < curr) {
1113 func(vblank, TDM_ERROR_NONE, sequence,
1114 TDM_TIME_SEC(seq_target), TDM_TIME_USEC(seq_target),
1116 return TDM_ERROR_NONE;
1117 } else if ((seq_target - curr) < 0.001) { /* 1ms */
1118 func(vblank, TDM_ERROR_NONE, sequence,
1119 TDM_TIME_SEC(curr), TDM_TIME_USEC(curr),
1121 return TDM_ERROR_NONE;
1124 interval = (unsigned int)((seq_target - curr) / private_vblank->vblank_gap + TDM_TIME_MARGIN) + 1;
1126 /* this seems error. But we handle this like normal to avoid the unexpected error in cliend side */
1127 TDM_WRN("sequence(%u) should be over the last sequence(%u)", sequence, private_vblank->last_seq);
1128 func(vblank, TDM_ERROR_NONE, private_vblank->last_seq,
1129 TDM_TIME_SEC(private_vblank->last_time), TDM_TIME_USEC(private_vblank->last_time),
1131 return TDM_ERROR_NONE;
1134 return tdm_vblank_wait(vblank, req_sec, req_usec, interval, func, user_data);
1138 tdm_vblank_set_add_front(tdm_vblank *vblank, unsigned int add_front)
1140 tdm_private_vblank *private_vblank = vblank;
1142 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
1144 TDM_RETURN_VAL_IF_FAIL(TDM_MUTEX_IS_LOCKED(), TDM_ERROR_OPERATION_FAILED);
1146 if (private_vblank->add_front == add_front)
1147 return TDM_ERROR_NONE;
1149 private_vblank->add_front = add_front;
1151 return TDM_ERROR_NONE;
1155 tdm_vblank_set_resource(tdm_vblank *vblank, struct wl_resource *resource)
1157 tdm_private_vblank *private_vblank = vblank;
1159 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
1160 TDM_RETURN_VAL_IF_FAIL(private_vblank->resource == NULL, TDM_ERROR_OPERATION_FAILED);
1162 private_vblank->resource = resource;
1164 return TDM_ERROR_NONE;
1168 tdm_vblank_get_vblank_list_information(tdm_display *dpy, char *reply, int *len)
1170 tdm_private_vblank *v = NULL;
1172 TDM_SNPRINTF(reply, len, "[Client Vblank List]\n");
1173 TDM_SNPRINTF(reply, len, "* global fps: %u\n", vblank_global_fps);
1174 TDM_SNPRINTF(reply, len, "---------------------------------------------------------------\n");
1175 TDM_SNPRINTF(reply, len, "name fps ignore offset fake process\n");
1176 TDM_SNPRINTF(reply, len, "---------------------------------------------------------------\n");
1178 pthread_mutex_lock(&valid_list_lock);
1179 LIST_FOR_EACH_ENTRY(v, &valid_vblank_list, valid_link) {
1180 struct wl_client *client = wl_resource_get_client(v->resource);
1181 const char *proc_name = NULL;
1185 wl_client_get_credentials(client, &pid, NULL, NULL);
1186 proc_name = tdm_server_get_client_name(pid);
1189 TDM_SNPRINTF(reply, len, "%-12s %u %u %d %u %s (pid: %u)\n",
1190 v->name, v->fps, v->ignore_global_fps, v->offset, v->enable_fake,
1191 (proc_name) ? proc_name : "Unknown", pid);
1193 pthread_mutex_unlock(&valid_list_lock);
1195 TDM_SNPRINTF(reply, len, "\n");